drivers/scsi/qla2xxx/qla_gs.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * QLogic Fibre Channel HBA Driver
   4  * Copyright (c)  2003-2014 QLogic Corporation
   5  */
   6 #include "qla_def.h"
   7 #include "qla_target.h"
   8 #include <linux/utsname.h>
   9
  10 static int qla2x00_sns_ga_nxt(scsi_qla_host_t *, fc_port_t *);
  11 static int qla2x00_sns_gid_pt(scsi_qla_host_t *, sw_info_t *);
  12 static int qla2x00_sns_gpn_id(scsi_qla_host_t *, sw_info_t *);
  13 static int qla2x00_sns_gnn_id(scsi_qla_host_t *, sw_info_t *);
  14 static int qla2x00_sns_rft_id(scsi_qla_host_t *);
  15 static int qla2x00_sns_rnn_id(scsi_qla_host_t *);
  16 static int qla_async_rftid(scsi_qla_host_t *, port_id_t *);
  17 static int qla_async_rffid(scsi_qla_host_t *, port_id_t *, u8, u8);
  18 static int qla_async_rnnid(scsi_qla_host_t *, port_id_t *, u8*);
  19 static int qla_async_rsnn_nn(scsi_qla_host_t *);
  20
  21
  22
  23 /**
  24  * qla2x00_prep_ms_iocb() - Prepare common MS/CT IOCB fields for SNS CT query.
  25  * @vha: HA context
  26  * @arg: CT arguments
  27  *
  28  * Returns a pointer to the @vha's ms_iocb.
  29  */
  30 void *
  31 qla2x00_prep_ms_iocb(scsi_qla_host_t *vha, struct ct_arg *arg)
  32 {
  33         struct qla_hw_data *ha = vha->hw;
  34         ms_iocb_entry_t *ms_pkt;
  35
  36         ms_pkt = (ms_iocb_entry_t *)arg->iocb;
  37         memset(ms_pkt, 0, sizeof(ms_iocb_entry_t));
  38
  39         ms_pkt->entry_type = MS_IOCB_TYPE;
  40         ms_pkt->entry_count = 1;
  41         SET_TARGET_ID(ha, ms_pkt->loop_id, SIMPLE_NAME_SERVER);
  42         ms_pkt->control_flags = cpu_to_le16(CF_READ | CF_HEAD_TAG);
  43         ms_pkt->timeout = cpu_to_le16(ha->r_a_tov / 10 * 2);
  44         ms_pkt->cmd_dsd_count = cpu_to_le16(1);
  45         ms_pkt->total_dsd_count = cpu_to_le16(2);
  46         ms_pkt->rsp_bytecount = cpu_to_le32(arg->rsp_size);
  47         ms_pkt->req_bytecount = cpu_to_le32(arg->req_size);
  48
  49         put_unaligned_le64(arg->req_dma, &ms_pkt->req_dsd.address);
  50         ms_pkt->req_dsd.length = ms_pkt->req_bytecount;
  51
  52         put_unaligned_le64(arg->rsp_dma, &ms_pkt->rsp_dsd.address);
  53         ms_pkt->rsp_dsd.length = ms_pkt->rsp_bytecount;
  54
  55         vha->qla_stats.control_requests++;
  56
  57         return (ms_pkt);
  58 }
  59
  60 /**
  61  * qla24xx_prep_ms_iocb() - Prepare common CT IOCB fields for SNS CT query.
  62  * @vha: HA context
  63  * @arg: CT arguments
  64  *
  65  * Returns a pointer to the @ha's ms_iocb.
  66  */
  67 void *
  68 qla24xx_prep_ms_iocb(scsi_qla_host_t *vha, struct ct_arg *arg)
  69 {
  70         struct qla_hw_data *ha = vha->hw;
  71         struct ct_entry_24xx *ct_pkt;
  72
  73         ct_pkt = (struct ct_entry_24xx *)arg->iocb;
  74         memset(ct_pkt, 0, sizeof(struct ct_entry_24xx));
  75
  76         ct_pkt->entry_type = CT_IOCB_TYPE;
  77         ct_pkt->entry_count = 1;
  78         ct_pkt->nport_handle = cpu_to_le16(arg->nport_handle);
  79         ct_pkt->timeout = cpu_to_le16(ha->r_a_tov / 10 * 2);
  80         ct_pkt->cmd_dsd_count = cpu_to_le16(1);
  81         ct_pkt->rsp_dsd_count = cpu_to_le16(1);
  82         ct_pkt->rsp_byte_count = cpu_to_le32(arg->rsp_size);
  83         ct_pkt->cmd_byte_count = cpu_to_le32(arg->req_size);
  84
  85         put_unaligned_le64(arg->req_dma, &ct_pkt->dsd[0].address);
  86         ct_pkt->dsd[0].length = ct_pkt->cmd_byte_count;
  87
  88         put_unaligned_le64(arg->rsp_dma, &ct_pkt->dsd[1].address);
  89         ct_pkt->dsd[1].length = ct_pkt->rsp_byte_count;
  90         ct_pkt->vp_index = vha->vp_idx;
  91
  92         vha->qla_stats.control_requests++;
  93
  94         return (ct_pkt);
  95 }
  96
  97 /**
  98  * qla2x00_prep_ct_req() - Prepare common CT request fields for SNS query.
  99  * @p: CT request buffer
 100  * @cmd: GS command
 101  * @rsp_size: response size in bytes
 102  *
 103  * Returns a pointer to the intitialized @ct_req.
 104  */
 105 static inline struct ct_sns_req *
 106 qla2x00_prep_ct_req(struct ct_sns_pkt *p, uint16_t cmd, uint16_t rsp_size)
 107 {
 108         memset(p, 0, sizeof(struct ct_sns_pkt));
 109
 110         p->p.req.header.revision = 0x01;
 111         p->p.req.header.gs_type = 0xFC;
 112         p->p.req.header.gs_subtype = 0x02;
 113         p->p.req.command = cpu_to_be16(cmd);
 114         p->p.req.max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
 115
 116         return &p->p.req;
 117 }
 118
 119 int
 120 qla2x00_chk_ms_status(scsi_qla_host_t *vha, ms_iocb_entry_t *ms_pkt,
 121     struct ct_sns_rsp *ct_rsp, const char *routine)
 122 {
 123         int rval;
 124         uint16_t comp_status;
 125         struct qla_hw_data *ha = vha->hw;
 126         bool lid_is_sns = false;
 127
 128         rval = QLA_FUNCTION_FAILED;
 129         if (ms_pkt->entry_status != 0) {
 130                 ql_dbg(ql_dbg_disc, vha, 0x2031,
 131                     "%s failed, error status (%x) on port_id: %02x%02x%02x.\n",
 132                     routine, ms_pkt->entry_status, vha->d_id.b.domain,
 133                     vha->d_id.b.area, vha->d_id.b.al_pa);
 134         } else {
 135                 if (IS_FWI2_CAPABLE(ha))
 136                         comp_status = le16_to_cpu(
 137                             ((struct ct_entry_24xx *)ms_pkt)->comp_status);
 138                 else
 139                         comp_status = le16_to_cpu(ms_pkt->status);
 140                 switch (comp_status) {
 141                 case CS_COMPLETE:
 142                 case CS_DATA_UNDERRUN:
 143                 case CS_DATA_OVERRUN:           /* Overrun? */
 144                         if (ct_rsp->header.response !=
 145                             cpu_to_be16(CT_ACCEPT_RESPONSE)) {
 146                                 ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x2077,
 147                                     "%s failed rejected request on port_id: %02x%02x%02x Completion status 0x%x, response 0x%x\n",
 148                                     routine, vha->d_id.b.domain,
 149                                     vha->d_id.b.area, vha->d_id.b.al_pa,
 150                                     comp_status, ct_rsp->header.response);
 151                                 ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha,
 152                                     0x2078, ct_rsp,
 153                                     offsetof(typeof(*ct_rsp), rsp));
 154                                 rval = QLA_INVALID_COMMAND;
 155                         } else
 156                                 rval = QLA_SUCCESS;
 157                         break;
 158                 case CS_PORT_LOGGED_OUT:
 159                         if (IS_FWI2_CAPABLE(ha)) {
 160                                 if (le16_to_cpu(ms_pkt->loop_id.extended) ==
 161                                     NPH_SNS)
 162                                         lid_is_sns = true;
 163                         } else {
 164                                 if (le16_to_cpu(ms_pkt->loop_id.extended) ==
 165                                     SIMPLE_NAME_SERVER)
 166                                         lid_is_sns = true;
 167                         }
 168                         if (lid_is_sns) {
 169                                 ql_dbg(ql_dbg_async, vha, 0x502b,
 170                                         "%s failed, Name server has logged out",
 171                                         routine);
 172                                 rval = QLA_NOT_LOGGED_IN;
 173                                 set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
 174                                 set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
 175                         }
 176                         break;
 177                 case CS_TIMEOUT:
 178                         rval = QLA_FUNCTION_TIMEOUT;
 179                         fallthrough;
 180                 default:
 181                         ql_dbg(ql_dbg_disc, vha, 0x2033,
 182                             "%s failed, completion status (%x) on port_id: "
 183                             "%02x%02x%02x.\n", routine, comp_status,
 184                             vha->d_id.b.domain, vha->d_id.b.area,
 185                             vha->d_id.b.al_pa);
 186                         break;
 187                 }
 188         }
 189         return rval;
 190 }
 191
 192 /**
 193  * qla2x00_ga_nxt() - SNS scan for fabric devices via GA_NXT command.
 194  * @vha: HA context
 195  * @fcport: fcport entry to updated
 196  *
 197  * Returns 0 on success.
 198  */
 199 int
 200 qla2x00_ga_nxt(scsi_qla_host_t *vha, fc_port_t *fcport)
 201 {
 202         int             rval;
 203
 204         ms_iocb_entry_t *ms_pkt;
 205         struct ct_sns_req       *ct_req;
 206         struct ct_sns_rsp       *ct_rsp;
 207         struct qla_hw_data *ha = vha->hw;
 208         struct ct_arg arg;
 209
 210         if (IS_QLA2100(ha) || IS_QLA2200(ha))
 211                 return qla2x00_sns_ga_nxt(vha, fcport);
 212
 213         arg.iocb = ha->ms_iocb;
 214         arg.req_dma = ha->ct_sns_dma;
 215         arg.rsp_dma = ha->ct_sns_dma;
 216         arg.req_size = GA_NXT_REQ_SIZE;
 217         arg.rsp_size = GA_NXT_RSP_SIZE;
 218         arg.nport_handle = NPH_SNS;
 219
 220         /* Issue GA_NXT */
 221         /* Prepare common MS IOCB */
 222         ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
 223
 224         /* Prepare CT request */
 225         ct_req = qla2x00_prep_ct_req(ha->ct_sns, GA_NXT_CMD,
 226             GA_NXT_RSP_SIZE);
 227         ct_rsp = &ha->ct_sns->p.rsp;
 228
 229         /* Prepare CT arguments -- port_id */
 230         ct_req->req.port_id.port_id = port_id_to_be_id(fcport->d_id);
 231
 232         /* Execute MS IOCB */
 233         rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
 234             sizeof(ms_iocb_entry_t));
 235         if (rval != QLA_SUCCESS) {
 236                 /*EMPTY*/
 237                 ql_dbg(ql_dbg_disc, vha, 0x2062,
 238                     "GA_NXT issue IOCB failed (%d).\n", rval);
 239         } else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "GA_NXT") !=
 240             QLA_SUCCESS) {
 241                 rval = QLA_FUNCTION_FAILED;
 242         } else {
 243                 /* Populate fc_port_t entry. */
 244                 fcport->d_id = be_to_port_id(ct_rsp->rsp.ga_nxt.port_id);
 245
 246                 memcpy(fcport->node_name, ct_rsp->rsp.ga_nxt.node_name,
 247                     WWN_SIZE);
 248                 memcpy(fcport->port_name, ct_rsp->rsp.ga_nxt.port_name,
 249                     WWN_SIZE);
 250
 251                 fcport->fc4_type = (ct_rsp->rsp.ga_nxt.fc4_types[2] & BIT_0) ?
 252                     FS_FC4TYPE_FCP : FC4_TYPE_OTHER;
 253
 254                 if (ct_rsp->rsp.ga_nxt.port_type != NS_N_PORT_TYPE &&
 255                     ct_rsp->rsp.ga_nxt.port_type != NS_NL_PORT_TYPE)
 256                         fcport->d_id.b.domain = 0xf0;
 257
 258                 ql_dbg(ql_dbg_disc, vha, 0x2063,
 259                     "GA_NXT entry - nn %8phN pn %8phN "
 260                     "port_id=%02x%02x%02x.\n",
 261                     fcport->node_name, fcport->port_name,
 262                     fcport->d_id.b.domain, fcport->d_id.b.area,
 263                     fcport->d_id.b.al_pa);
 264         }
 265
 266         return (rval);
 267 }
 268
 269 static inline int
 270 qla2x00_gid_pt_rsp_size(scsi_qla_host_t *vha)
 271 {
 272         return vha->hw->max_fibre_devices * 4 + 16;
 273 }
 274
 275 /**
 276  * qla2x00_gid_pt() - SNS scan for fabric devices via GID_PT command.
 277  * @vha: HA context
 278  * @list: switch info entries to populate
 279  *
 280  * NOTE: Non-Nx_Ports are not requested.
 281  *
 282  * Returns 0 on success.
 283  */
 284 int
 285 qla2x00_gid_pt(scsi_qla_host_t *vha, sw_info_t *list)
 286 {
 287         int             rval;
 288         uint16_t        i;
 289
 290         ms_iocb_entry_t *ms_pkt;
 291         struct ct_sns_req       *ct_req;
 292         struct ct_sns_rsp       *ct_rsp;
 293
 294         struct ct_sns_gid_pt_data *gid_data;
 295         struct qla_hw_data *ha = vha->hw;
 296         uint16_t gid_pt_rsp_size;
 297         struct ct_arg arg;
 298
 299         if (IS_QLA2100(ha) || IS_QLA2200(ha))
 300                 return qla2x00_sns_gid_pt(vha, list);
 301
 302         gid_data = NULL;
 303         gid_pt_rsp_size = qla2x00_gid_pt_rsp_size(vha);
 304
 305         arg.iocb = ha->ms_iocb;
 306         arg.req_dma = ha->ct_sns_dma;
 307         arg.rsp_dma = ha->ct_sns_dma;
 308         arg.req_size = GID_PT_REQ_SIZE;
 309         arg.rsp_size = gid_pt_rsp_size;
 310         arg.nport_handle = NPH_SNS;
 311
 312         /* Issue GID_PT */
 313         /* Prepare common MS IOCB */
 314         ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
 315
 316         /* Prepare CT request */
 317         ct_req = qla2x00_prep_ct_req(ha->ct_sns, GID_PT_CMD, gid_pt_rsp_size);
 318         ct_rsp = &ha->ct_sns->p.rsp;
 319
 320         /* Prepare CT arguments -- port_type */
 321         ct_req->req.gid_pt.port_type = NS_NX_PORT_TYPE;
 322
 323         /* Execute MS IOCB */
 324         rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
 325             sizeof(ms_iocb_entry_t));
 326         if (rval != QLA_SUCCESS) {
 327                 /*EMPTY*/
 328                 ql_dbg(ql_dbg_disc, vha, 0x2055,
 329                     "GID_PT issue IOCB failed (%d).\n", rval);
 330         } else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "GID_PT") !=
 331             QLA_SUCCESS) {
 332                 rval = QLA_FUNCTION_FAILED;
 333         } else {
 334                 /* Set port IDs in switch info list. */
 335                 for (i = 0; i < ha->max_fibre_devices; i++) {
 336                         gid_data = &ct_rsp->rsp.gid_pt.entries[i];
 337                         list[i].d_id = be_to_port_id(gid_data->port_id);
 338                         memset(list[i].fabric_port_name, 0, WWN_SIZE);
 339                         list[i].fp_speed = PORT_SPEED_UNKNOWN;
 340
 341                         /* Last one exit. */
 342                         if (gid_data->control_byte & BIT_7) {
 343                                 list[i].d_id.b.rsvd_1 = gid_data->control_byte;
 344                                 break;
 345                         }
 346                 }
 347
 348                 /*
 349                  * If we've used all available slots, then the switch is
 350                  * reporting back more devices than we can handle with this
 351                  * single call.  Return a failed status, and let GA_NXT handle
 352                  * the overload.
 353                  */
 354                 if (i == ha->max_fibre_devices)
 355                         rval = QLA_FUNCTION_FAILED;
 356         }
 357
 358         return (rval);
 359 }
 360
 361 /**
 362  * qla2x00_gpn_id() - SNS Get Port Name (GPN_ID) query.
 363  * @vha: HA context
 364  * @list: switch info entries to populate
 365  *
 366  * Returns 0 on success.
 367  */
 368 int
 369 qla2x00_gpn_id(scsi_qla_host_t *vha, sw_info_t *list)
 370 {
 371         int             rval = QLA_SUCCESS;
 372         uint16_t        i;
 373
 374         ms_iocb_entry_t *ms_pkt;
 375         struct ct_sns_req       *ct_req;
 376         struct ct_sns_rsp       *ct_rsp;
 377         struct qla_hw_data *ha = vha->hw;
 378         struct ct_arg arg;
 379
 380         if (IS_QLA2100(ha) || IS_QLA2200(ha))
 381                 return qla2x00_sns_gpn_id(vha, list);
 382
 383         arg.iocb = ha->ms_iocb;
 384         arg.req_dma = ha->ct_sns_dma;
 385         arg.rsp_dma = ha->ct_sns_dma;
 386         arg.req_size = GPN_ID_REQ_SIZE;
 387         arg.rsp_size = GPN_ID_RSP_SIZE;
 388         arg.nport_handle = NPH_SNS;
 389
 390         for (i = 0; i < ha->max_fibre_devices; i++) {
 391                 /* Issue GPN_ID */
 392                 /* Prepare common MS IOCB */
 393                 ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
 394
 395                 /* Prepare CT request */
 396                 ct_req = qla2x00_prep_ct_req(ha->ct_sns, GPN_ID_CMD,
 397                     GPN_ID_RSP_SIZE);
 398                 ct_rsp = &ha->ct_sns->p.rsp;
 399
 400                 /* Prepare CT arguments -- port_id */
 401                 ct_req->req.port_id.port_id = port_id_to_be_id(list[i].d_id);
 402
 403                 /* Execute MS IOCB */
 404                 rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
 405                     sizeof(ms_iocb_entry_t));
 406                 if (rval != QLA_SUCCESS) {
 407                         /*EMPTY*/
 408                         ql_dbg(ql_dbg_disc, vha, 0x2056,
 409                             "GPN_ID issue IOCB failed (%d).\n", rval);
 410                         break;
 411                 } else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp,
 412                     "GPN_ID") != QLA_SUCCESS) {
 413                         rval = QLA_FUNCTION_FAILED;
 414                         break;
 415                 } else {
 416                         /* Save portname */
 417                         memcpy(list[i].port_name,
 418                             ct_rsp->rsp.gpn_id.port_name, WWN_SIZE);
 419                 }
 420
 421                 /* Last device exit. */
 422                 if (list[i].d_id.b.rsvd_1 != 0)
 423                         break;
 424         }
 425
 426         return (rval);
 427 }
 428
 429 /**
 430  * qla2x00_gnn_id() - SNS Get Node Name (GNN_ID) query.
 431  * @vha: HA context
 432  * @list: switch info entries to populate
 433  *
 434  * Returns 0 on success.
 435  */
 436 int
 437 qla2x00_gnn_id(scsi_qla_host_t *vha, sw_info_t *list)
 438 {
 439         int             rval = QLA_SUCCESS;
 440         uint16_t        i;
 441         struct qla_hw_data *ha = vha->hw;
 442         ms_iocb_entry_t *ms_pkt;
 443         struct ct_sns_req       *ct_req;
 444         struct ct_sns_rsp       *ct_rsp;
 445         struct ct_arg arg;
 446
 447         if (IS_QLA2100(ha) || IS_QLA2200(ha))
 448                 return qla2x00_sns_gnn_id(vha, list);
 449
 450         arg.iocb = ha->ms_iocb;
 451         arg.req_dma = ha->ct_sns_dma;
 452         arg.rsp_dma = ha->ct_sns_dma;
 453         arg.req_size = GNN_ID_REQ_SIZE;
 454         arg.rsp_size = GNN_ID_RSP_SIZE;
 455         arg.nport_handle = NPH_SNS;
 456
 457         for (i = 0; i < ha->max_fibre_devices; i++) {
 458                 /* Issue GNN_ID */
 459                 /* Prepare common MS IOCB */
 460                 ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
 461
 462                 /* Prepare CT request */
 463                 ct_req = qla2x00_prep_ct_req(ha->ct_sns, GNN_ID_CMD,
 464                     GNN_ID_RSP_SIZE);
 465                 ct_rsp = &ha->ct_sns->p.rsp;
 466
 467                 /* Prepare CT arguments -- port_id */
 468                 ct_req->req.port_id.port_id = port_id_to_be_id(list[i].d_id);
 469
 470                 /* Execute MS IOCB */
 471                 rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
 472                     sizeof(ms_iocb_entry_t));
 473                 if (rval != QLA_SUCCESS) {
 474                         /*EMPTY*/
 475                         ql_dbg(ql_dbg_disc, vha, 0x2057,
 476                             "GNN_ID issue IOCB failed (%d).\n", rval);
 477                         break;
 478                 } else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp,
 479                     "GNN_ID") != QLA_SUCCESS) {
 480                         rval = QLA_FUNCTION_FAILED;
 481                         break;
 482                 } else {
 483                         /* Save nodename */
 484                         memcpy(list[i].node_name,
 485                             ct_rsp->rsp.gnn_id.node_name, WWN_SIZE);
 486
 487                         ql_dbg(ql_dbg_disc, vha, 0x2058,
 488                             "GID_PT entry - nn %8phN pn %8phN "
 489                             "portid=%02x%02x%02x.\n",
 490                             list[i].node_name, list[i].port_name,
 491                             list[i].d_id.b.domain, list[i].d_id.b.area,
 492                             list[i].d_id.b.al_pa);
 493                 }
 494
 495                 /* Last device exit. */
 496                 if (list[i].d_id.b.rsvd_1 != 0)
 497                         break;
 498         }
 499
 500         return (rval);
 501 }
 502
 503 static void qla2x00_async_sns_sp_done(srb_t *sp, int rc)
 504 {
 505         struct scsi_qla_host *vha = sp->vha;
 506         struct ct_sns_pkt *ct_sns;
 507         struct qla_work_evt *e;
 508
 509         sp->rc = rc;
 510         if (rc == QLA_SUCCESS) {
 511                 ql_dbg(ql_dbg_disc, vha, 0x204f,
 512                     "Async done-%s exiting normally.\n",
 513                     sp->name);
 514         } else if (rc == QLA_FUNCTION_TIMEOUT) {
 515                 ql_dbg(ql_dbg_disc, vha, 0x204f,
 516                     "Async done-%s timeout\n", sp->name);
 517         } else {
 518                 ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
 519                 memset(ct_sns, 0, sizeof(*ct_sns));
 520                 sp->retry_count++;
 521                 if (sp->retry_count > 3)
 522                         goto err;
 523
 524                 ql_dbg(ql_dbg_disc, vha, 0x204f,
 525                     "Async done-%s fail rc %x.  Retry count %d\n",
 526                     sp->name, rc, sp->retry_count);
 527
 528                 e = qla2x00_alloc_work(vha, QLA_EVT_SP_RETRY);
 529                 if (!e)
 530                         goto err2;
 531
 532                 del_timer(&sp->u.iocb_cmd.timer);
 533                 e->u.iosb.sp = sp;
 534                 qla2x00_post_work(vha, e);
 535                 return;
 536         }
 537
 538 err:
 539         e = qla2x00_alloc_work(vha, QLA_EVT_UNMAP);
 540 err2:
 541         if (!e) {
 542                 /* please ignore kernel warning. otherwise, we have mem leak. */
 543                 if (sp->u.iocb_cmd.u.ctarg.req) {
 544                         dma_free_coherent(&vha->hw->pdev->dev,
 545                             sp->u.iocb_cmd.u.ctarg.req_allocated_size,
 546                             sp->u.iocb_cmd.u.ctarg.req,
 547                             sp->u.iocb_cmd.u.ctarg.req_dma);
 548                         sp->u.iocb_cmd.u.ctarg.req = NULL;
 549                 }
 550
 551                 if (sp->u.iocb_cmd.u.ctarg.rsp) {
 552                         dma_free_coherent(&vha->hw->pdev->dev,
 553                             sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
 554                             sp->u.iocb_cmd.u.ctarg.rsp,
 555                             sp->u.iocb_cmd.u.ctarg.rsp_dma);
 556                         sp->u.iocb_cmd.u.ctarg.rsp = NULL;
 557                 }
 558
 559                 sp->free(sp);
 560
 561                 return;
 562         }
 563
 564         e->u.iosb.sp = sp;
 565         qla2x00_post_work(vha, e);
 566 }
 567
 568 /**
 569  * qla2x00_rft_id() - SNS Register FC-4 TYPEs (RFT_ID) supported by the HBA.
 570  * @vha: HA context
 571  *
 572  * Returns 0 on success.
 573  */
 574 int
 575 qla2x00_rft_id(scsi_qla_host_t *vha)
 576 {
 577         struct qla_hw_data *ha = vha->hw;
 578
 579         if (IS_QLA2100(ha) || IS_QLA2200(ha))
 580                 return qla2x00_sns_rft_id(vha);
 581
 582         return qla_async_rftid(vha, &vha->d_id);
 583 }
 584
 585 static int qla_async_rftid(scsi_qla_host_t *vha, port_id_t *d_id)
 586 {
 587         int rval = QLA_MEMORY_ALLOC_FAILED;
 588         struct ct_sns_req *ct_req;
 589         srb_t *sp;
 590         struct ct_sns_pkt *ct_sns;
 591
 592         if (!vha->flags.online)
 593                 goto done;
 594
 595         sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
 596         if (!sp)
 597                 goto done;
 598
 599         sp->type = SRB_CT_PTHRU_CMD;
 600         sp->name = "rft_id";
 601         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
 602
 603         sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
 604             sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.req_dma,
 605             GFP_KERNEL);
 606         sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
 607         if (!sp->u.iocb_cmd.u.ctarg.req) {
 608                 ql_log(ql_log_warn, vha, 0xd041,
 609                     "%s: Failed to allocate ct_sns request.\n",
 610                     __func__);
 611                 goto done_free_sp;
 612         }
 613
 614         sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
 615             sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.rsp_dma,
 616             GFP_KERNEL);
 617         sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = sizeof(struct ct_sns_pkt);
 618         if (!sp->u.iocb_cmd.u.ctarg.rsp) {
 619                 ql_log(ql_log_warn, vha, 0xd042,
 620                     "%s: Failed to allocate ct_sns request.\n",
 621                     __func__);
 622                 goto done_free_sp;
 623         }
 624         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
 625         memset(ct_sns, 0, sizeof(*ct_sns));
 626         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
 627
 628         /* Prepare CT request */
 629         ct_req = qla2x00_prep_ct_req(ct_sns, RFT_ID_CMD, RFT_ID_RSP_SIZE);
 630
 631         /* Prepare CT arguments -- port_id, FC-4 types */
 632         ct_req->req.rft_id.port_id = port_id_to_be_id(vha->d_id);
 633         ct_req->req.rft_id.fc4_types[2] = 0x01;         /* FCP-3 */
 634
 635         if (vha->flags.nvme_enabled)
 636                 ct_req->req.rft_id.fc4_types[6] = 1;    /* NVMe type 28h */
 637
 638         sp->u.iocb_cmd.u.ctarg.req_size = RFT_ID_REQ_SIZE;
 639         sp->u.iocb_cmd.u.ctarg.rsp_size = RFT_ID_RSP_SIZE;
 640         sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
 641         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
 642         sp->done = qla2x00_async_sns_sp_done;
 643
 644         ql_dbg(ql_dbg_disc, vha, 0xffff,
 645             "Async-%s - hdl=%x portid %06x.\n",
 646             sp->name, sp->handle, d_id->b24);
 647
 648         rval = qla2x00_start_sp(sp);
 649         if (rval != QLA_SUCCESS) {
 650                 ql_dbg(ql_dbg_disc, vha, 0x2043,
 651                     "RFT_ID issue IOCB failed (%d).\n", rval);
 652                 goto done_free_sp;
 653         }
 654         return rval;
 655 done_free_sp:
 656         sp->free(sp);
 657 done:
 658         return rval;
 659 }
 660
 661 /**
 662  * qla2x00_rff_id() - SNS Register FC-4 Features (RFF_ID) supported by the HBA.
 663  * @vha: HA context
 664  * @type: not used
 665  *
 666  * Returns 0 on success.
 667  */
 668 int
 669 qla2x00_rff_id(scsi_qla_host_t *vha, u8 type)
 670 {
 671         struct qla_hw_data *ha = vha->hw;
 672
 673         if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 674                 ql_dbg(ql_dbg_disc, vha, 0x2046,
 675                     "RFF_ID call not supported on ISP2100/ISP2200.\n");
 676                 return (QLA_SUCCESS);
 677         }
 678
 679         return qla_async_rffid(vha, &vha->d_id, qlt_rff_id(vha),
 680             FC4_TYPE_FCP_SCSI);
 681 }
 682
 683 static int qla_async_rffid(scsi_qla_host_t *vha, port_id_t *d_id,
 684     u8 fc4feature, u8 fc4type)
 685 {
 686         int rval = QLA_MEMORY_ALLOC_FAILED;
 687         struct ct_sns_req *ct_req;
 688         srb_t *sp;
 689         struct ct_sns_pkt *ct_sns;
 690
 691         sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
 692         if (!sp)
 693                 goto done;
 694
 695         sp->type = SRB_CT_PTHRU_CMD;
 696         sp->name = "rff_id";
 697         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
 698
 699         sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
 700             sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.req_dma,
 701             GFP_KERNEL);
 702         sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
 703         if (!sp->u.iocb_cmd.u.ctarg.req) {
 704                 ql_log(ql_log_warn, vha, 0xd041,
 705                     "%s: Failed to allocate ct_sns request.\n",
 706                     __func__);
 707                 goto done_free_sp;
 708         }
 709
 710         sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
 711             sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.rsp_dma,
 712             GFP_KERNEL);
 713         sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = sizeof(struct ct_sns_pkt);
 714         if (!sp->u.iocb_cmd.u.ctarg.rsp) {
 715                 ql_log(ql_log_warn, vha, 0xd042,
 716                     "%s: Failed to allocate ct_sns request.\n",
 717                     __func__);
 718                 goto done_free_sp;
 719         }
 720         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
 721         memset(ct_sns, 0, sizeof(*ct_sns));
 722         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
 723
 724         /* Prepare CT request */
 725         ct_req = qla2x00_prep_ct_req(ct_sns, RFF_ID_CMD, RFF_ID_RSP_SIZE);
 726
 727         /* Prepare CT arguments -- port_id, FC-4 feature, FC-4 type */
 728         ct_req->req.rff_id.port_id = port_id_to_be_id(*d_id);
 729         ct_req->req.rff_id.fc4_feature = fc4feature;
 730         ct_req->req.rff_id.fc4_type = fc4type;          /* SCSI - FCP */
 731
 732         sp->u.iocb_cmd.u.ctarg.req_size = RFF_ID_REQ_SIZE;
 733         sp->u.iocb_cmd.u.ctarg.rsp_size = RFF_ID_RSP_SIZE;
 734         sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
 735         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
 736         sp->done = qla2x00_async_sns_sp_done;
 737
 738         ql_dbg(ql_dbg_disc, vha, 0xffff,
 739             "Async-%s - hdl=%x portid %06x feature %x type %x.\n",
 740             sp->name, sp->handle, d_id->b24, fc4feature, fc4type);
 741
 742         rval = qla2x00_start_sp(sp);
 743         if (rval != QLA_SUCCESS) {
 744                 ql_dbg(ql_dbg_disc, vha, 0x2047,
 745                     "RFF_ID issue IOCB failed (%d).\n", rval);
 746                 goto done_free_sp;
 747         }
 748
 749         return rval;
 750
 751 done_free_sp:
 752         sp->free(sp);
 753 done:
 754         return rval;
 755 }
 756
 757 /**
 758  * qla2x00_rnn_id() - SNS Register Node Name (RNN_ID) of the HBA.
 759  * @vha: HA context
 760  *
 761  * Returns 0 on success.
 762  */
 763 int
 764 qla2x00_rnn_id(scsi_qla_host_t *vha)
 765 {
 766         struct qla_hw_data *ha = vha->hw;
 767
 768         if (IS_QLA2100(ha) || IS_QLA2200(ha))
 769                 return qla2x00_sns_rnn_id(vha);
 770
 771         return  qla_async_rnnid(vha, &vha->d_id, vha->node_name);
 772 }
 773
 774 static int qla_async_rnnid(scsi_qla_host_t *vha, port_id_t *d_id,
 775         u8 *node_name)
 776 {
 777         int rval = QLA_MEMORY_ALLOC_FAILED;
 778         struct ct_sns_req *ct_req;
 779         srb_t *sp;
 780         struct ct_sns_pkt *ct_sns;
 781
 782         sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
 783         if (!sp)
 784                 goto done;
 785
 786         sp->type = SRB_CT_PTHRU_CMD;
 787         sp->name = "rnid";
 788         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
 789
 790         sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
 791             sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.req_dma,
 792             GFP_KERNEL);
 793         sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
 794         if (!sp->u.iocb_cmd.u.ctarg.req) {
 795                 ql_log(ql_log_warn, vha, 0xd041,
 796                     "%s: Failed to allocate ct_sns request.\n",
 797                     __func__);
 798                 goto done_free_sp;
 799         }
 800
 801         sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
 802             sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.rsp_dma,
 803             GFP_KERNEL);
 804         sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = sizeof(struct ct_sns_pkt);
 805         if (!sp->u.iocb_cmd.u.ctarg.rsp) {
 806                 ql_log(ql_log_warn, vha, 0xd042,
 807                     "%s: Failed to allocate ct_sns request.\n",
 808                     __func__);
 809                 goto done_free_sp;
 810         }
 811         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
 812         memset(ct_sns, 0, sizeof(*ct_sns));
 813         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
 814
 815         /* Prepare CT request */
 816         ct_req = qla2x00_prep_ct_req(ct_sns, RNN_ID_CMD, RNN_ID_RSP_SIZE);
 817
 818         /* Prepare CT arguments -- port_id, node_name */
 819         ct_req->req.rnn_id.port_id = port_id_to_be_id(vha->d_id);
 820         memcpy(ct_req->req.rnn_id.node_name, vha->node_name, WWN_SIZE);
 821
 822         sp->u.iocb_cmd.u.ctarg.req_size = RNN_ID_REQ_SIZE;
 823         sp->u.iocb_cmd.u.ctarg.rsp_size = RNN_ID_RSP_SIZE;
 824         sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
 825
 826         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
 827         sp->done = qla2x00_async_sns_sp_done;
 828
 829         ql_dbg(ql_dbg_disc, vha, 0xffff,
 830             "Async-%s - hdl=%x portid %06x\n",
 831             sp->name, sp->handle, d_id->b24);
 832
 833         rval = qla2x00_start_sp(sp);
 834         if (rval != QLA_SUCCESS) {
 835                 ql_dbg(ql_dbg_disc, vha, 0x204d,
 836                     "RNN_ID issue IOCB failed (%d).\n", rval);
 837                 goto done_free_sp;
 838         }
 839
 840         return rval;
 841
 842 done_free_sp:
 843         sp->free(sp);
 844 done:
 845         return rval;
 846 }
 847
 848 size_t
 849 qla2x00_get_sym_node_name(scsi_qla_host_t *vha, uint8_t *snn, size_t size)
 850 {
 851         struct qla_hw_data *ha = vha->hw;
 852
 853         if (IS_QLAFX00(ha))
 854                 return scnprintf(snn, size, "%s FW:v%s DVR:v%s",
 855                     ha->model_number, ha->mr.fw_version, qla2x00_version_str);
 856
 857         return scnprintf(snn, size, "%s FW:v%d.%02d.%02d DVR:v%s",
 858             ha->model_number, ha->fw_major_version, ha->fw_minor_version,
 859             ha->fw_subminor_version, qla2x00_version_str);
 860 }
 861
 862 /**
 863  * qla2x00_rsnn_nn() - SNS Register Symbolic Node Name (RSNN_NN) of the HBA.
 864  * @vha: HA context
 865  *
 866  * Returns 0 on success.
 867  */
 868 int
 869 qla2x00_rsnn_nn(scsi_qla_host_t *vha)
 870 {
 871         struct qla_hw_data *ha = vha->hw;
 872
 873         if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 874                 ql_dbg(ql_dbg_disc, vha, 0x2050,
 875                     "RSNN_ID call unsupported on ISP2100/ISP2200.\n");
 876                 return (QLA_SUCCESS);
 877         }
 878
 879         return qla_async_rsnn_nn(vha);
 880 }
 881
 882 static int qla_async_rsnn_nn(scsi_qla_host_t *vha)
 883 {
 884         int rval = QLA_MEMORY_ALLOC_FAILED;
 885         struct ct_sns_req *ct_req;
 886         srb_t *sp;
 887         struct ct_sns_pkt *ct_sns;
 888
 889         sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
 890         if (!sp)
 891                 goto done;
 892
 893         sp->type = SRB_CT_PTHRU_CMD;
 894         sp->name = "rsnn_nn";
 895         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
 896
 897         sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
 898             sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.req_dma,
 899             GFP_KERNEL);
 900         sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
 901         if (!sp->u.iocb_cmd.u.ctarg.req) {
 902                 ql_log(ql_log_warn, vha, 0xd041,
 903                     "%s: Failed to allocate ct_sns request.\n",
 904                     __func__);
 905                 goto done_free_sp;
 906         }
 907
 908         sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
 909             sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.rsp_dma,
 910             GFP_KERNEL);
 911         sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = sizeof(struct ct_sns_pkt);
 912         if (!sp->u.iocb_cmd.u.ctarg.rsp) {
 913                 ql_log(ql_log_warn, vha, 0xd042,
 914                     "%s: Failed to allocate ct_sns request.\n",
 915                     __func__);
 916                 goto done_free_sp;
 917         }
 918         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
 919         memset(ct_sns, 0, sizeof(*ct_sns));
 920         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
 921
 922         /* Prepare CT request */
 923         ct_req = qla2x00_prep_ct_req(ct_sns, RSNN_NN_CMD, RSNN_NN_RSP_SIZE);
 924
 925         /* Prepare CT arguments -- node_name, symbolic node_name, size */
 926         memcpy(ct_req->req.rsnn_nn.node_name, vha->node_name, WWN_SIZE);
 927
 928         /* Prepare the Symbolic Node Name */
 929         qla2x00_get_sym_node_name(vha, ct_req->req.rsnn_nn.sym_node_name,
 930             sizeof(ct_req->req.rsnn_nn.sym_node_name));
 931         ct_req->req.rsnn_nn.name_len =
 932             (uint8_t)strlen(ct_req->req.rsnn_nn.sym_node_name);
 933
 934
 935         sp->u.iocb_cmd.u.ctarg.req_size = 24 + 1 + ct_req->req.rsnn_nn.name_len;
 936         sp->u.iocb_cmd.u.ctarg.rsp_size = RSNN_NN_RSP_SIZE;
 937         sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
 938
 939         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
 940         sp->done = qla2x00_async_sns_sp_done;
 941
 942         ql_dbg(ql_dbg_disc, vha, 0xffff,
 943             "Async-%s - hdl=%x.\n",
 944             sp->name, sp->handle);
 945
 946         rval = qla2x00_start_sp(sp);
 947         if (rval != QLA_SUCCESS) {
 948                 ql_dbg(ql_dbg_disc, vha, 0x2043,
 949                     "RFT_ID issue IOCB failed (%d).\n", rval);
 950                 goto done_free_sp;
 951         }
 952
 953         return rval;
 954
 955 done_free_sp:
 956         sp->free(sp);
 957 done:
 958         return rval;
 959 }
 960
 961 /**
 962  * qla2x00_prep_sns_cmd() - Prepare common SNS command request fields for query.
 963  * @vha: HA context
 964  * @cmd: GS command
 965  * @scmd_len: Subcommand length
 966  * @data_size: response size in bytes
 967  *
 968  * Returns a pointer to the @ha's sns_cmd.
 969  */
 970 static inline struct sns_cmd_pkt *
 971 qla2x00_prep_sns_cmd(scsi_qla_host_t *vha, uint16_t cmd, uint16_t scmd_len,
 972     uint16_t data_size)
 973 {
 974         uint16_t                wc;
 975         struct sns_cmd_pkt      *sns_cmd;
 976         struct qla_hw_data *ha = vha->hw;
 977
 978         sns_cmd = ha->sns_cmd;
 979         memset(sns_cmd, 0, sizeof(struct sns_cmd_pkt));
 980         wc = data_size / 2;                     /* Size in 16bit words. */
 981         sns_cmd->p.cmd.buffer_length = cpu_to_le16(wc);
 982         put_unaligned_le64(ha->sns_cmd_dma, &sns_cmd->p.cmd.buffer_address);
 983         sns_cmd->p.cmd.subcommand_length = cpu_to_le16(scmd_len);
 984         sns_cmd->p.cmd.subcommand = cpu_to_le16(cmd);
 985         wc = (data_size - 16) / 4;              /* Size in 32bit words. */
 986         sns_cmd->p.cmd.size = cpu_to_le16(wc);
 987
 988         vha->qla_stats.control_requests++;
 989
 990         return (sns_cmd);
 991 }
 992
 993 /**
 994  * qla2x00_sns_ga_nxt() - SNS scan for fabric devices via GA_NXT command.
 995  * @vha: HA context
 996  * @fcport: fcport entry to updated
 997  *
 998  * This command uses the old Exectute SNS Command mailbox routine.
 999  *
1000  * Returns 0 on success.
1001  */
1002 static int
1003 qla2x00_sns_ga_nxt(scsi_qla_host_t *vha, fc_port_t *fcport)
1004 {
1005         int             rval = QLA_SUCCESS;
1006         struct qla_hw_data *ha = vha->hw;
1007         struct sns_cmd_pkt      *sns_cmd;
1008
1009         /* Issue GA_NXT. */
1010         /* Prepare SNS command request. */
1011         sns_cmd = qla2x00_prep_sns_cmd(vha, GA_NXT_CMD, GA_NXT_SNS_SCMD_LEN,
1012             GA_NXT_SNS_DATA_SIZE);
1013
1014         /* Prepare SNS command arguments -- port_id. */
1015         sns_cmd->p.cmd.param[0] = fcport->d_id.b.al_pa;
1016         sns_cmd->p.cmd.param[1] = fcport->d_id.b.area;
1017         sns_cmd->p.cmd.param[2] = fcport->d_id.b.domain;
1018
1019         /* Execute SNS command. */
1020         rval = qla2x00_send_sns(vha, ha->sns_cmd_dma, GA_NXT_SNS_CMD_SIZE / 2,
1021             sizeof(struct sns_cmd_pkt));
1022         if (rval != QLA_SUCCESS) {
1023                 /*EMPTY*/
1024                 ql_dbg(ql_dbg_disc, vha, 0x205f,
1025                     "GA_NXT Send SNS failed (%d).\n", rval);
1026         } else if (sns_cmd->p.gan_data[8] != 0x80 ||
1027             sns_cmd->p.gan_data[9] != 0x02) {
1028                 ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x2084,
1029                     "GA_NXT failed, rejected request ga_nxt_rsp:\n");
1030                 ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x2074,
1031                     sns_cmd->p.gan_data, 16);
1032                 rval = QLA_FUNCTION_FAILED;
1033         } else {
1034                 /* Populate fc_port_t entry. */
1035                 fcport->d_id.b.domain = sns_cmd->p.gan_data[17];
1036                 fcport->d_id.b.area = sns_cmd->p.gan_data[18];
1037                 fcport->d_id.b.al_pa = sns_cmd->p.gan_data[19];
1038
1039                 memcpy(fcport->node_name, &sns_cmd->p.gan_data[284], WWN_SIZE);
1040                 memcpy(fcport->port_name, &sns_cmd->p.gan_data[20], WWN_SIZE);
1041
1042                 if (sns_cmd->p.gan_data[16] != NS_N_PORT_TYPE &&
1043                     sns_cmd->p.gan_data[16] != NS_NL_PORT_TYPE)
1044                         fcport->d_id.b.domain = 0xf0;
1045
1046                 ql_dbg(ql_dbg_disc, vha, 0x2061,
1047                     "GA_NXT entry - nn %8phN pn %8phN "
1048                     "port_id=%02x%02x%02x.\n",
1049                     fcport->node_name, fcport->port_name,
1050                     fcport->d_id.b.domain, fcport->d_id.b.area,
1051                     fcport->d_id.b.al_pa);
1052         }
1053
1054         return (rval);
1055 }
1056
1057 /**
1058  * qla2x00_sns_gid_pt() - SNS scan for fabric devices via GID_PT command.
1059  * @vha: HA context
1060  * @list: switch info entries to populate
1061  *
1062  * This command uses the old Exectute SNS Command mailbox routine.
1063  *
1064  * NOTE: Non-Nx_Ports are not requested.
1065  *
1066  * Returns 0 on success.
1067  */
1068 static int
1069 qla2x00_sns_gid_pt(scsi_qla_host_t *vha, sw_info_t *list)
1070 {
1071         int             rval;
1072         struct qla_hw_data *ha = vha->hw;
1073         uint16_t        i;
1074         uint8_t         *entry;
1075         struct sns_cmd_pkt      *sns_cmd;
1076         uint16_t gid_pt_sns_data_size;
1077
1078         gid_pt_sns_data_size = qla2x00_gid_pt_rsp_size(vha);
1079
1080         /* Issue GID_PT. */
1081         /* Prepare SNS command request. */
1082         sns_cmd = qla2x00_prep_sns_cmd(vha, GID_PT_CMD, GID_PT_SNS_SCMD_LEN,
1083             gid_pt_sns_data_size);
1084
1085         /* Prepare SNS command arguments -- port_type. */
1086         sns_cmd->p.cmd.param[0] = NS_NX_PORT_TYPE;
1087
1088         /* Execute SNS command. */
1089         rval = qla2x00_send_sns(vha, ha->sns_cmd_dma, GID_PT_SNS_CMD_SIZE / 2,
1090             sizeof(struct sns_cmd_pkt));
1091         if (rval != QLA_SUCCESS) {
1092                 /*EMPTY*/
1093                 ql_dbg(ql_dbg_disc, vha, 0x206d,
1094                     "GID_PT Send SNS failed (%d).\n", rval);
1095         } else if (sns_cmd->p.gid_data[8] != 0x80 ||
1096             sns_cmd->p.gid_data[9] != 0x02) {
1097                 ql_dbg(ql_dbg_disc, vha, 0x202f,
1098                     "GID_PT failed, rejected request, gid_rsp:\n");
1099                 ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x2081,
1100                     sns_cmd->p.gid_data, 16);
1101                 rval = QLA_FUNCTION_FAILED;
1102         } else {
1103                 /* Set port IDs in switch info list. */
1104                 for (i = 0; i < ha->max_fibre_devices; i++) {
1105                         entry = &sns_cmd->p.gid_data[(i * 4) + 16];
1106                         list[i].d_id.b.domain = entry[1];
1107                         list[i].d_id.b.area = entry[2];
1108                         list[i].d_id.b.al_pa = entry[3];
1109
1110                         /* Last one exit. */
1111                         if (entry[0] & BIT_7) {
1112                                 list[i].d_id.b.rsvd_1 = entry[0];
1113                                 break;
1114                         }
1115                 }
1116
1117                 /*
1118                  * If we've used all available slots, then the switch is
1119                  * reporting back more devices that we can handle with this
1120                  * single call.  Return a failed status, and let GA_NXT handle
1121                  * the overload.
1122                  */
1123                 if (i == ha->max_fibre_devices)
1124                         rval = QLA_FUNCTION_FAILED;
1125         }
1126
1127         return (rval);
1128 }
1129
1130 /**
1131  * qla2x00_sns_gpn_id() - SNS Get Port Name (GPN_ID) query.
1132  * @vha: HA context
1133  * @list: switch info entries to populate
1134  *
1135  * This command uses the old Exectute SNS Command mailbox routine.
1136  *
1137  * Returns 0 on success.
1138  */
1139 static int
1140 qla2x00_sns_gpn_id(scsi_qla_host_t *vha, sw_info_t *list)
1141 {
1142         int             rval = QLA_SUCCESS;
1143         struct qla_hw_data *ha = vha->hw;
1144         uint16_t        i;
1145         struct sns_cmd_pkt      *sns_cmd;
1146
1147         for (i = 0; i < ha->max_fibre_devices; i++) {
1148                 /* Issue GPN_ID */
1149                 /* Prepare SNS command request. */
1150                 sns_cmd = qla2x00_prep_sns_cmd(vha, GPN_ID_CMD,
1151                     GPN_ID_SNS_SCMD_LEN, GPN_ID_SNS_DATA_SIZE);
1152
1153                 /* Prepare SNS command arguments -- port_id. */
1154                 sns_cmd->p.cmd.param[0] = list[i].d_id.b.al_pa;
1155                 sns_cmd->p.cmd.param[1] = list[i].d_id.b.area;
1156                 sns_cmd->p.cmd.param[2] = list[i].d_id.b.domain;
1157
1158                 /* Execute SNS command. */
1159                 rval = qla2x00_send_sns(vha, ha->sns_cmd_dma,
1160                     GPN_ID_SNS_CMD_SIZE / 2, sizeof(struct sns_cmd_pkt));
1161                 if (rval != QLA_SUCCESS) {
1162                         /*EMPTY*/
1163                         ql_dbg(ql_dbg_disc, vha, 0x2032,
1164                             "GPN_ID Send SNS failed (%d).\n", rval);
1165                 } else if (sns_cmd->p.gpn_data[8] != 0x80 ||
1166                     sns_cmd->p.gpn_data[9] != 0x02) {
1167                         ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x207e,
1168                             "GPN_ID failed, rejected request, gpn_rsp:\n");
1169                         ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x207f,
1170                             sns_cmd->p.gpn_data, 16);
1171                         rval = QLA_FUNCTION_FAILED;
1172                 } else {
1173                         /* Save portname */
1174                         memcpy(list[i].port_name, &sns_cmd->p.gpn_data[16],
1175                             WWN_SIZE);
1176                 }
1177
1178                 /* Last device exit. */
1179                 if (list[i].d_id.b.rsvd_1 != 0)
1180                         break;
1181         }
1182
1183         return (rval);
1184 }
1185
1186 /**
1187  * qla2x00_sns_gnn_id() - SNS Get Node Name (GNN_ID) query.
1188  * @vha: HA context
1189  * @list: switch info entries to populate
1190  *
1191  * This command uses the old Exectute SNS Command mailbox routine.
1192  *
1193  * Returns 0 on success.
1194  */
1195 static int
1196 qla2x00_sns_gnn_id(scsi_qla_host_t *vha, sw_info_t *list)
1197 {
1198         int             rval = QLA_SUCCESS;
1199         struct qla_hw_data *ha = vha->hw;
1200         uint16_t        i;
1201         struct sns_cmd_pkt      *sns_cmd;
1202
1203         for (i = 0; i < ha->max_fibre_devices; i++) {
1204                 /* Issue GNN_ID */
1205                 /* Prepare SNS command request. */
1206                 sns_cmd = qla2x00_prep_sns_cmd(vha, GNN_ID_CMD,
1207                     GNN_ID_SNS_SCMD_LEN, GNN_ID_SNS_DATA_SIZE);
1208
1209                 /* Prepare SNS command arguments -- port_id. */
1210                 sns_cmd->p.cmd.param[0] = list[i].d_id.b.al_pa;
1211                 sns_cmd->p.cmd.param[1] = list[i].d_id.b.area;
1212                 sns_cmd->p.cmd.param[2] = list[i].d_id.b.domain;
1213
1214                 /* Execute SNS command. */
1215                 rval = qla2x00_send_sns(vha, ha->sns_cmd_dma,
1216                     GNN_ID_SNS_CMD_SIZE / 2, sizeof(struct sns_cmd_pkt));
1217                 if (rval != QLA_SUCCESS) {
1218                         /*EMPTY*/
1219                         ql_dbg(ql_dbg_disc, vha, 0x203f,
1220                             "GNN_ID Send SNS failed (%d).\n", rval);
1221                 } else if (sns_cmd->p.gnn_data[8] != 0x80 ||
1222                     sns_cmd->p.gnn_data[9] != 0x02) {
1223                         ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x2082,
1224                             "GNN_ID failed, rejected request, gnn_rsp:\n");
1225                         ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x207a,
1226                             sns_cmd->p.gnn_data, 16);
1227                         rval = QLA_FUNCTION_FAILED;
1228                 } else {
1229                         /* Save nodename */
1230                         memcpy(list[i].node_name, &sns_cmd->p.gnn_data[16],
1231                             WWN_SIZE);
1232
1233                         ql_dbg(ql_dbg_disc, vha, 0x206e,
1234                             "GID_PT entry - nn %8phN pn %8phN "
1235                             "port_id=%02x%02x%02x.\n",
1236                             list[i].node_name, list[i].port_name,
1237                             list[i].d_id.b.domain, list[i].d_id.b.area,
1238                             list[i].d_id.b.al_pa);
1239                 }
1240
1241                 /* Last device exit. */
1242                 if (list[i].d_id.b.rsvd_1 != 0)
1243                         break;
1244         }
1245
1246         return (rval);
1247 }
1248
1249 /**
1250  * qla2x00_sns_rft_id() - SNS Register FC-4 TYPEs (RFT_ID) supported by the HBA.
1251  * @vha: HA context
1252  *
1253  * This command uses the old Exectute SNS Command mailbox routine.
1254  *
1255  * Returns 0 on success.
1256  */
1257 static int
1258 qla2x00_sns_rft_id(scsi_qla_host_t *vha)
1259 {
1260         int             rval;
1261         struct qla_hw_data *ha = vha->hw;
1262         struct sns_cmd_pkt      *sns_cmd;
1263
1264         /* Issue RFT_ID. */
1265         /* Prepare SNS command request. */
1266         sns_cmd = qla2x00_prep_sns_cmd(vha, RFT_ID_CMD, RFT_ID_SNS_SCMD_LEN,
1267             RFT_ID_SNS_DATA_SIZE);
1268
1269         /* Prepare SNS command arguments -- port_id, FC-4 types */
1270         sns_cmd->p.cmd.param[0] = vha->d_id.b.al_pa;
1271         sns_cmd->p.cmd.param[1] = vha->d_id.b.area;
1272         sns_cmd->p.cmd.param[2] = vha->d_id.b.domain;
1273
1274         sns_cmd->p.cmd.param[5] = 0x01;                 /* FCP-3 */
1275
1276         /* Execute SNS command. */
1277         rval = qla2x00_send_sns(vha, ha->sns_cmd_dma, RFT_ID_SNS_CMD_SIZE / 2,
1278             sizeof(struct sns_cmd_pkt));
1279         if (rval != QLA_SUCCESS) {
1280                 /*EMPTY*/
1281                 ql_dbg(ql_dbg_disc, vha, 0x2060,
1282                     "RFT_ID Send SNS failed (%d).\n", rval);
1283         } else if (sns_cmd->p.rft_data[8] != 0x80 ||
1284             sns_cmd->p.rft_data[9] != 0x02) {
1285                 ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x2083,
1286                     "RFT_ID failed, rejected request rft_rsp:\n");
1287                 ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x2080,
1288                     sns_cmd->p.rft_data, 16);
1289                 rval = QLA_FUNCTION_FAILED;
1290         } else {
1291                 ql_dbg(ql_dbg_disc, vha, 0x2073,
1292                     "RFT_ID exiting normally.\n");
1293         }
1294
1295         return (rval);
1296 }
1297
1298 /**
1299  * qla2x00_sns_rnn_id() - SNS Register Node Name (RNN_ID) of the HBA.
1300  * @vha: HA context
1301  *
1302  * This command uses the old Exectute SNS Command mailbox routine.
1303  *
1304  * Returns 0 on success.
1305  */
1306 static int
1307 qla2x00_sns_rnn_id(scsi_qla_host_t *vha)
1308 {
1309         int             rval;
1310         struct qla_hw_data *ha = vha->hw;
1311         struct sns_cmd_pkt      *sns_cmd;
1312
1313         /* Issue RNN_ID. */
1314         /* Prepare SNS command request. */
1315         sns_cmd = qla2x00_prep_sns_cmd(vha, RNN_ID_CMD, RNN_ID_SNS_SCMD_LEN,
1316             RNN_ID_SNS_DATA_SIZE);
1317
1318         /* Prepare SNS command arguments -- port_id, nodename. */
1319         sns_cmd->p.cmd.param[0] = vha->d_id.b.al_pa;
1320         sns_cmd->p.cmd.param[1] = vha->d_id.b.area;
1321         sns_cmd->p.cmd.param[2] = vha->d_id.b.domain;
1322
1323         sns_cmd->p.cmd.param[4] = vha->node_name[7];
1324         sns_cmd->p.cmd.param[5] = vha->node_name[6];
1325         sns_cmd->p.cmd.param[6] = vha->node_name[5];
1326         sns_cmd->p.cmd.param[7] = vha->node_name[4];
1327         sns_cmd->p.cmd.param[8] = vha->node_name[3];
1328         sns_cmd->p.cmd.param[9] = vha->node_name[2];
1329         sns_cmd->p.cmd.param[10] = vha->node_name[1];
1330         sns_cmd->p.cmd.param[11] = vha->node_name[0];
1331
1332         /* Execute SNS command. */
1333         rval = qla2x00_send_sns(vha, ha->sns_cmd_dma, RNN_ID_SNS_CMD_SIZE / 2,
1334             sizeof(struct sns_cmd_pkt));
1335         if (rval != QLA_SUCCESS) {
1336                 /*EMPTY*/
1337                 ql_dbg(ql_dbg_disc, vha, 0x204a,
1338                     "RNN_ID Send SNS failed (%d).\n", rval);
1339         } else if (sns_cmd->p.rnn_data[8] != 0x80 ||
1340             sns_cmd->p.rnn_data[9] != 0x02) {
1341                 ql_dbg(ql_dbg_disc + ql_dbg_buffer, vha, 0x207b,
1342                     "RNN_ID failed, rejected request, rnn_rsp:\n");
1343                 ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x207c,
1344                     sns_cmd->p.rnn_data, 16);
1345                 rval = QLA_FUNCTION_FAILED;
1346         } else {
1347                 ql_dbg(ql_dbg_disc, vha, 0x204c,
1348                     "RNN_ID exiting normally.\n");
1349         }
1350
1351         return (rval);
1352 }
1353
1354 /**
1355  * qla2x00_mgmt_svr_login() - Login to fabric Management Service.
1356  * @vha: HA context
1357  *
1358  * Returns 0 on success.
1359  */
1360 int
1361 qla2x00_mgmt_svr_login(scsi_qla_host_t *vha)
1362 {
1363         int ret, rval;
1364         uint16_t mb[MAILBOX_REGISTER_COUNT];
1365         struct qla_hw_data *ha = vha->hw;
1366
1367         ret = QLA_SUCCESS;
1368         if (vha->flags.management_server_logged_in)
1369                 return ret;
1370
1371         rval = ha->isp_ops->fabric_login(vha, vha->mgmt_svr_loop_id, 0xff, 0xff,
1372             0xfa, mb, BIT_1);
1373         if (rval != QLA_SUCCESS || mb[0] != MBS_COMMAND_COMPLETE) {
1374                 if (rval == QLA_MEMORY_ALLOC_FAILED)
1375                         ql_dbg(ql_dbg_disc, vha, 0x2085,
1376                             "Failed management_server login: loopid=%x "
1377                             "rval=%d\n", vha->mgmt_svr_loop_id, rval);
1378                 else
1379                         ql_dbg(ql_dbg_disc, vha, 0x2024,
1380                             "Failed management_server login: loopid=%x "
1381                             "mb[0]=%x mb[1]=%x mb[2]=%x mb[6]=%x mb[7]=%x.\n",
1382                             vha->mgmt_svr_loop_id, mb[0], mb[1], mb[2], mb[6],
1383                             mb[7]);
1384                 ret = QLA_FUNCTION_FAILED;
1385         } else
1386                 vha->flags.management_server_logged_in = 1;
1387
1388         return ret;
1389 }
1390
1391 /**
1392  * qla2x00_prep_ms_fdmi_iocb() - Prepare common MS IOCB fields for FDMI query.
1393  * @vha: HA context
1394  * @req_size: request size in bytes
1395  * @rsp_size: response size in bytes
1396  *
1397  * Returns a pointer to the @ha's ms_iocb.
1398  */
1399 void *
1400 qla2x00_prep_ms_fdmi_iocb(scsi_qla_host_t *vha, uint32_t req_size,
1401     uint32_t rsp_size)
1402 {
1403         ms_iocb_entry_t *ms_pkt;
1404         struct qla_hw_data *ha = vha->hw;
1405
1406         ms_pkt = ha->ms_iocb;
1407         memset(ms_pkt, 0, sizeof(ms_iocb_entry_t));
1408
1409         ms_pkt->entry_type = MS_IOCB_TYPE;
1410         ms_pkt->entry_count = 1;
1411         SET_TARGET_ID(ha, ms_pkt->loop_id, vha->mgmt_svr_loop_id);
1412         ms_pkt->control_flags = cpu_to_le16(CF_READ | CF_HEAD_TAG);
1413         ms_pkt->timeout = cpu_to_le16(ha->r_a_tov / 10 * 2);
1414         ms_pkt->cmd_dsd_count = cpu_to_le16(1);
1415         ms_pkt->total_dsd_count = cpu_to_le16(2);
1416         ms_pkt->rsp_bytecount = cpu_to_le32(rsp_size);
1417         ms_pkt->req_bytecount = cpu_to_le32(req_size);
1418
1419         put_unaligned_le64(ha->ct_sns_dma, &ms_pkt->req_dsd.address);
1420         ms_pkt->req_dsd.length = ms_pkt->req_bytecount;
1421
1422         put_unaligned_le64(ha->ct_sns_dma, &ms_pkt->rsp_dsd.address);
1423         ms_pkt->rsp_dsd.length = ms_pkt->rsp_bytecount;
1424
1425         return ms_pkt;
1426 }
1427
1428 /**
1429  * qla24xx_prep_ms_fdmi_iocb() - Prepare common MS IOCB fields for FDMI query.
1430  * @vha: HA context
1431  * @req_size: request size in bytes
1432  * @rsp_size: response size in bytes
1433  *
1434  * Returns a pointer to the @ha's ms_iocb.
1435  */
1436 void *
1437 qla24xx_prep_ms_fdmi_iocb(scsi_qla_host_t *vha, uint32_t req_size,
1438     uint32_t rsp_size)
1439 {
1440         struct ct_entry_24xx *ct_pkt;
1441         struct qla_hw_data *ha = vha->hw;
1442
1443         ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
1444         memset(ct_pkt, 0, sizeof(struct ct_entry_24xx));
1445
1446         ct_pkt->entry_type = CT_IOCB_TYPE;
1447         ct_pkt->entry_count = 1;
1448         ct_pkt->nport_handle = cpu_to_le16(vha->mgmt_svr_loop_id);
1449         ct_pkt->timeout = cpu_to_le16(ha->r_a_tov / 10 * 2);
1450         ct_pkt->cmd_dsd_count = cpu_to_le16(1);
1451         ct_pkt->rsp_dsd_count = cpu_to_le16(1);
1452         ct_pkt->rsp_byte_count = cpu_to_le32(rsp_size);
1453         ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
1454
1455         put_unaligned_le64(ha->ct_sns_dma, &ct_pkt->dsd[0].address);
1456         ct_pkt->dsd[0].length = ct_pkt->cmd_byte_count;
1457
1458         put_unaligned_le64(ha->ct_sns_dma, &ct_pkt->dsd[1].address);
1459         ct_pkt->dsd[1].length = ct_pkt->rsp_byte_count;
1460         ct_pkt->vp_index = vha->vp_idx;
1461
1462         return ct_pkt;
1463 }
1464
1465 static void
1466 qla2x00_update_ms_fdmi_iocb(scsi_qla_host_t *vha, uint32_t req_size)
1467 {
1468         struct qla_hw_data *ha = vha->hw;
1469         ms_iocb_entry_t *ms_pkt = ha->ms_iocb;
1470         struct ct_entry_24xx *ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
1471
1472         if (IS_FWI2_CAPABLE(ha)) {
1473                 ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
1474                 ct_pkt->dsd[0].length = ct_pkt->cmd_byte_count;
1475         } else {
1476                 ms_pkt->req_bytecount = cpu_to_le32(req_size);
1477                 ms_pkt->req_dsd.length = ms_pkt->req_bytecount;
1478         }
1479 }
1480
1481 /**
1482  * qla2x00_prep_ct_fdmi_req() - Prepare common CT request fields for SNS query.
1483  * @p: CT request buffer
1484  * @cmd: GS command
1485  * @rsp_size: response size in bytes
1486  *
1487  * Returns a pointer to the intitialized @ct_req.
1488  */
1489 static inline struct ct_sns_req *
1490 qla2x00_prep_ct_fdmi_req(struct ct_sns_pkt *p, uint16_t cmd,
1491     uint16_t rsp_size)
1492 {
1493         memset(p, 0, sizeof(struct ct_sns_pkt));
1494
1495         p->p.req.header.revision = 0x01;
1496         p->p.req.header.gs_type = 0xFA;
1497         p->p.req.header.gs_subtype = 0x10;
1498         p->p.req.command = cpu_to_be16(cmd);
1499         p->p.req.max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
1500
1501         return &p->p.req;
1502 }
1503
1504 uint
1505 qla25xx_fdmi_port_speed_capability(struct qla_hw_data *ha)
1506 {
1507         uint speeds = 0;
1508
1509         if (IS_CNA_CAPABLE(ha))
1510                 return FDMI_PORT_SPEED_10GB;
1511         if (IS_QLA28XX(ha) || IS_QLA27XX(ha)) {
1512                 if (ha->max_supported_speed == 2) {
1513                         if (ha->min_supported_speed <= 6)
1514                                 speeds |= FDMI_PORT_SPEED_64GB;
1515                 }
1516                 if (ha->max_supported_speed == 2 ||
1517                     ha->max_supported_speed == 1) {
1518                         if (ha->min_supported_speed <= 5)
1519                                 speeds |= FDMI_PORT_SPEED_32GB;
1520                 }
1521                 if (ha->max_supported_speed == 2 ||
1522                     ha->max_supported_speed == 1 ||
1523                     ha->max_supported_speed == 0) {
1524                         if (ha->min_supported_speed <= 4)
1525                                 speeds |= FDMI_PORT_SPEED_16GB;
1526                 }
1527                 if (ha->max_supported_speed == 1 ||
1528                     ha->max_supported_speed == 0) {
1529                         if (ha->min_supported_speed <= 3)
1530                                 speeds |= FDMI_PORT_SPEED_8GB;
1531                 }
1532                 if (ha->max_supported_speed == 0) {
1533                         if (ha->min_supported_speed <= 2)
1534                                 speeds |= FDMI_PORT_SPEED_4GB;
1535                 }
1536                 return speeds;
1537         }
1538         if (IS_QLA2031(ha)) {
1539                 if ((ha->pdev->subsystem_vendor == 0x103C) &&
1540                     (ha->pdev->subsystem_device == 0x8002)) {
1541                         speeds = FDMI_PORT_SPEED_16GB;
1542                 } else {
1543                         speeds = FDMI_PORT_SPEED_16GB|FDMI_PORT_SPEED_8GB|
1544                                 FDMI_PORT_SPEED_4GB;
1545                 }
1546                 return speeds;
1547         }
1548         if (IS_QLA25XX(ha) || IS_QLAFX00(ha))
1549                 return FDMI_PORT_SPEED_8GB|FDMI_PORT_SPEED_4GB|
1550                         FDMI_PORT_SPEED_2GB|FDMI_PORT_SPEED_1GB;
1551         if (IS_QLA24XX_TYPE(ha))
1552                 return FDMI_PORT_SPEED_4GB|FDMI_PORT_SPEED_2GB|
1553                         FDMI_PORT_SPEED_1GB;
1554         if (IS_QLA23XX(ha))
1555                 return FDMI_PORT_SPEED_2GB|FDMI_PORT_SPEED_1GB;
1556         return FDMI_PORT_SPEED_1GB;
1557 }
1558
1559 uint
1560 qla25xx_fdmi_port_speed_currently(struct qla_hw_data *ha)
1561 {
1562         switch (ha->link_data_rate) {
1563         case PORT_SPEED_1GB:
1564                 return FDMI_PORT_SPEED_1GB;
1565         case PORT_SPEED_2GB:
1566                 return FDMI_PORT_SPEED_2GB;
1567         case PORT_SPEED_4GB:
1568                 return FDMI_PORT_SPEED_4GB;
1569         case PORT_SPEED_8GB:
1570                 return FDMI_PORT_SPEED_8GB;
1571         case PORT_SPEED_10GB:
1572                 return FDMI_PORT_SPEED_10GB;
1573         case PORT_SPEED_16GB:
1574                 return FDMI_PORT_SPEED_16GB;
1575         case PORT_SPEED_32GB:
1576                 return FDMI_PORT_SPEED_32GB;
1577         case PORT_SPEED_64GB:
1578                 return FDMI_PORT_SPEED_64GB;
1579         default:
1580                 return FDMI_PORT_SPEED_UNKNOWN;
1581         }
1582 }
1583
1584 /**
1585  * qla2x00_hba_attributes() - perform HBA attributes registration
1586  * @vha: HA context
1587  * @entries: number of entries to use
1588  * @callopt: Option to issue extended or standard FDMI
1589  *           command parameter
1590  *
1591  * Returns 0 on success.
1592  */
1593 static unsigned long
1594 qla2x00_hba_attributes(scsi_qla_host_t *vha, void *entries,
1595         unsigned int callopt)
1596 {
1597         struct qla_hw_data *ha = vha->hw;
1598         struct init_cb_24xx *icb24 = (void *)ha->init_cb;
1599         struct new_utsname *p_sysid = utsname();
1600         struct ct_fdmi_hba_attr *eiter;
1601         uint16_t alen;
1602         unsigned long size = 0;
1603
1604         /* Nodename. */
1605         eiter = entries + size;
1606         eiter->type = cpu_to_be16(FDMI_HBA_NODE_NAME);
1607         memcpy(eiter->a.node_name, vha->node_name, sizeof(eiter->a.node_name));
1608         alen = sizeof(eiter->a.node_name);
1609         alen += FDMI_ATTR_TYPELEN(eiter);
1610         eiter->len = cpu_to_be16(alen);
1611         size += alen;
1612         ql_dbg(ql_dbg_disc, vha, 0x20a0,
1613             "NODENAME = %016llx.\n", wwn_to_u64(eiter->a.node_name));
1614         /* Manufacturer. */
1615         eiter = entries + size;
1616         eiter->type = cpu_to_be16(FDMI_HBA_MANUFACTURER);
1617         alen = scnprintf(
1618                 eiter->a.manufacturer, sizeof(eiter->a.manufacturer),
1619                 "%s", "QLogic Corporation");
1620         alen += FDMI_ATTR_ALIGNMENT(alen);
1621         alen += FDMI_ATTR_TYPELEN(eiter);
1622         eiter->len = cpu_to_be16(alen);
1623         size += alen;
1624         ql_dbg(ql_dbg_disc, vha, 0x20a1,
1625             "MANUFACTURER = %s.\n", eiter->a.manufacturer);
1626         /* Serial number. */
1627         eiter = entries + size;
1628         eiter->type = cpu_to_be16(FDMI_HBA_SERIAL_NUMBER);
1629         alen = 0;
1630         if (IS_FWI2_CAPABLE(ha)) {
1631                 alen = qla2xxx_get_vpd_field(vha, "SN",
1632                     eiter->a.serial_num, sizeof(eiter->a.serial_num));
1633         }
1634         if (!alen) {
1635                 uint32_t sn = ((ha->serial0 & 0x1f) << 16) |
1636                         (ha->serial2 << 8) | ha->serial1;
1637                 alen = scnprintf(
1638                         eiter->a.serial_num, sizeof(eiter->a.serial_num),
1639                         "%c%05d", 'A' + sn / 100000, sn % 100000);
1640         }
1641         alen += FDMI_ATTR_ALIGNMENT(alen);
1642         alen += FDMI_ATTR_TYPELEN(eiter);
1643         eiter->len = cpu_to_be16(alen);
1644         size += alen;
1645         ql_dbg(ql_dbg_disc, vha, 0x20a2,
1646             "SERIAL NUMBER = %s.\n", eiter->a.serial_num);
1647         /* Model name. */
1648         eiter = entries + size;
1649         eiter->type = cpu_to_be16(FDMI_HBA_MODEL);
1650         alen = scnprintf(
1651                 eiter->a.model, sizeof(eiter->a.model),
1652                 "%s", ha->model_number);
1653         alen += FDMI_ATTR_ALIGNMENT(alen);
1654         alen += FDMI_ATTR_TYPELEN(eiter);
1655         eiter->len = cpu_to_be16(alen);
1656         size += alen;
1657         ql_dbg(ql_dbg_disc, vha, 0x20a3,
1658             "MODEL NAME = %s.\n", eiter->a.model);
1659         /* Model description. */
1660         eiter = entries + size;
1661         eiter->type = cpu_to_be16(FDMI_HBA_MODEL_DESCRIPTION);
1662         alen = scnprintf(
1663                 eiter->a.model_desc, sizeof(eiter->a.model_desc),
1664                 "%s", ha->model_desc);
1665         alen += FDMI_ATTR_ALIGNMENT(alen);
1666         alen += FDMI_ATTR_TYPELEN(eiter);
1667         eiter->len = cpu_to_be16(alen);
1668         size += alen;
1669         ql_dbg(ql_dbg_disc, vha, 0x20a4,
1670             "MODEL DESCRIPTION = %s.\n", eiter->a.model_desc);
1671         /* Hardware version. */
1672         eiter = entries + size;
1673         eiter->type = cpu_to_be16(FDMI_HBA_HARDWARE_VERSION);
1674         alen = 0;
1675         if (IS_FWI2_CAPABLE(ha)) {
1676                 if (!alen) {
1677                         alen = qla2xxx_get_vpd_field(vha, "MN",
1678                             eiter->a.hw_version, sizeof(eiter->a.hw_version));
1679                 }
1680                 if (!alen) {
1681                         alen = qla2xxx_get_vpd_field(vha, "EC",
1682                             eiter->a.hw_version, sizeof(eiter->a.hw_version));
1683                 }
1684         }
1685         if (!alen) {
1686                 alen = scnprintf(
1687                         eiter->a.hw_version, sizeof(eiter->a.hw_version),
1688                         "HW:%s", ha->adapter_id);
1689         }
1690         alen += FDMI_ATTR_ALIGNMENT(alen);
1691         alen += FDMI_ATTR_TYPELEN(eiter);
1692         eiter->len = cpu_to_be16(alen);
1693         size += alen;
1694         ql_dbg(ql_dbg_disc, vha, 0x20a5,
1695             "HARDWARE VERSION = %s.\n", eiter->a.hw_version);
1696         /* Driver version. */
1697         eiter = entries + size;
1698         eiter->type = cpu_to_be16(FDMI_HBA_DRIVER_VERSION);
1699         alen = scnprintf(
1700                 eiter->a.driver_version, sizeof(eiter->a.driver_version),
1701                 "%s", qla2x00_version_str);
1702         alen += FDMI_ATTR_ALIGNMENT(alen);
1703         alen += FDMI_ATTR_TYPELEN(eiter);
1704         eiter->len = cpu_to_be16(alen);
1705         size += alen;
1706         ql_dbg(ql_dbg_disc, vha, 0x20a6,
1707             "DRIVER VERSION = %s.\n", eiter->a.driver_version);
1708         /* Option ROM version. */
1709         eiter = entries + size;
1710         eiter->type = cpu_to_be16(FDMI_HBA_OPTION_ROM_VERSION);
1711         alen = scnprintf(
1712                 eiter->a.orom_version, sizeof(eiter->a.orom_version),
1713                 "%d.%02d", ha->bios_revision[1], ha->bios_revision[0]);
1714         alen += FDMI_ATTR_ALIGNMENT(alen);
1715         alen += FDMI_ATTR_TYPELEN(eiter);
1716         eiter->len = cpu_to_be16(alen);
1717         size += alen;
1718
1719         ql_dbg(ql_dbg_disc, vha, 0x20a7,
1720             "OPTROM VERSION = %d.%02d.\n",
1721             eiter->a.orom_version[1], eiter->a.orom_version[0]);
1722         /* Firmware version */
1723         eiter = entries + size;
1724         eiter->type = cpu_to_be16(FDMI_HBA_FIRMWARE_VERSION);
1725         ha->isp_ops->fw_version_str(vha, eiter->a.fw_version,
1726             sizeof(eiter->a.fw_version));
1727         alen += FDMI_ATTR_ALIGNMENT(alen);
1728         alen += FDMI_ATTR_TYPELEN(eiter);
1729         eiter->len = cpu_to_be16(alen);
1730         size += alen;
1731         ql_dbg(ql_dbg_disc, vha, 0x20a8,
1732             "FIRMWARE VERSION = %s.\n", eiter->a.fw_version);
1733         if (callopt == CALLOPT_FDMI1)
1734                 goto done;
1735         /* OS Name and Version */
1736         eiter = entries + size;
1737         eiter->type = cpu_to_be16(FDMI_HBA_OS_NAME_AND_VERSION);
1738         alen = 0;
1739         if (p_sysid) {
1740                 alen = scnprintf(
1741                         eiter->a.os_version, sizeof(eiter->a.os_version),
1742                         "%s %s %s",
1743                         p_sysid->sysname, p_sysid->release, p_sysid->machine);
1744         }
1745         if (!alen) {
1746                 alen = scnprintf(
1747                         eiter->a.os_version, sizeof(eiter->a.os_version),
1748                         "%s %s",
1749                         "Linux", fc_host_system_hostname(vha->host));
1750         }
1751         alen += FDMI_ATTR_ALIGNMENT(alen);
1752         alen += FDMI_ATTR_TYPELEN(eiter);
1753         eiter->len = cpu_to_be16(alen);
1754         size += alen;
1755         ql_dbg(ql_dbg_disc, vha, 0x20a9,
1756             "OS VERSION = %s.\n", eiter->a.os_version);
1757         /* MAX CT Payload Length */
1758         eiter = entries + size;
1759         eiter->type = cpu_to_be16(FDMI_HBA_MAXIMUM_CT_PAYLOAD_LENGTH);
1760         eiter->a.max_ct_len = cpu_to_be32(le16_to_cpu(IS_FWI2_CAPABLE(ha) ?
1761                 icb24->frame_payload_size : ha->init_cb->frame_payload_size));
1762         alen = sizeof(eiter->a.max_ct_len);
1763         alen += FDMI_ATTR_TYPELEN(eiter);
1764         eiter->len = cpu_to_be16(alen);
1765         size += alen;
1766         ql_dbg(ql_dbg_disc, vha, 0x20aa,
1767             "CT PAYLOAD LENGTH = 0x%x.\n", be32_to_cpu(eiter->a.max_ct_len));
1768         /* Node Sybolic Name */
1769         eiter = entries + size;
1770         eiter->type = cpu_to_be16(FDMI_HBA_NODE_SYMBOLIC_NAME);
1771         alen = qla2x00_get_sym_node_name(vha, eiter->a.sym_name,
1772             sizeof(eiter->a.sym_name));
1773         alen += FDMI_ATTR_ALIGNMENT(alen);
1774         alen += FDMI_ATTR_TYPELEN(eiter);
1775         eiter->len = cpu_to_be16(alen);
1776         size += alen;
1777         ql_dbg(ql_dbg_disc, vha, 0x20ab,
1778             "SYMBOLIC NAME = %s.\n", eiter->a.sym_name);
1779         /* Vendor Specific information */
1780         eiter = entries + size;
1781         eiter->type = cpu_to_be16(FDMI_HBA_VENDOR_SPECIFIC_INFO);
1782         eiter->a.vendor_specific_info = cpu_to_be32(PCI_VENDOR_ID_QLOGIC);
1783         alen = sizeof(eiter->a.vendor_specific_info);
1784         alen += FDMI_ATTR_TYPELEN(eiter);
1785         eiter->len = cpu_to_be16(alen);
1786         size += alen;
1787         ql_dbg(ql_dbg_disc, vha, 0x20ac,
1788             "VENDOR SPECIFIC INFO = 0x%x.\n",
1789             be32_to_cpu(eiter->a.vendor_specific_info));
1790         /* Num Ports */
1791         eiter = entries + size;
1792         eiter->type = cpu_to_be16(FDMI_HBA_NUM_PORTS);
1793         eiter->a.num_ports = cpu_to_be32(1);
1794         alen = sizeof(eiter->a.num_ports);
1795         alen += FDMI_ATTR_TYPELEN(eiter);
1796         eiter->len = cpu_to_be16(alen);
1797         size += alen;
1798         ql_dbg(ql_dbg_disc, vha, 0x20ad,
1799             "PORT COUNT = %x.\n", be32_to_cpu(eiter->a.num_ports));
1800         /* Fabric Name */
1801         eiter = entries + size;
1802         eiter->type = cpu_to_be16(FDMI_HBA_FABRIC_NAME);
1803         memcpy(eiter->a.fabric_name, vha->fabric_node_name,
1804             sizeof(eiter->a.fabric_name));
1805         alen = sizeof(eiter->a.fabric_name);
1806         alen += FDMI_ATTR_TYPELEN(eiter);
1807         eiter->len = cpu_to_be16(alen);
1808         size += alen;
1809         ql_dbg(ql_dbg_disc, vha, 0x20ae,
1810             "FABRIC NAME = %016llx.\n", wwn_to_u64(eiter->a.fabric_name));
1811         /* BIOS Version */
1812         eiter = entries + size;
1813         eiter->type = cpu_to_be16(FDMI_HBA_BOOT_BIOS_NAME);
1814         alen = scnprintf(
1815                 eiter->a.bios_name, sizeof(eiter->a.bios_name),
1816                 "BIOS %d.%02d", ha->bios_revision[1], ha->bios_revision[0]);
1817         alen += FDMI_ATTR_ALIGNMENT(alen);
1818         alen += FDMI_ATTR_TYPELEN(eiter);
1819         eiter->len = cpu_to_be16(alen);
1820         size += alen;
1821         ql_dbg(ql_dbg_disc, vha, 0x20af,
1822             "BIOS NAME = %s\n", eiter->a.bios_name);
1823         /* Vendor Identifier */
1824         eiter = entries + size;
1825         eiter->type = cpu_to_be16(FDMI_HBA_VENDOR_IDENTIFIER);
1826         alen = scnprintf(
1827                 eiter->a.vendor_identifier, sizeof(eiter->a.vendor_identifier),
1828                 "%s", "QLGC");
1829         alen += FDMI_ATTR_ALIGNMENT(alen);
1830         alen += FDMI_ATTR_TYPELEN(eiter);
1831         eiter->len = cpu_to_be16(alen);
1832         size += alen;
1833         ql_dbg(ql_dbg_disc, vha, 0x20b0,
1834             "VENDOR IDENTIFIER = %s.\n", eiter->a.vendor_identifier);
1835 done:
1836         return size;
1837 }
1838
1839 /**
1840  * qla2x00_port_attributes() - perform Port attributes registration
1841  * @vha: HA context
1842  * @entries: number of entries to use
1843  * @callopt: Option to issue extended or standard FDMI
1844  *           command parameter
1845  *
1846  * Returns 0 on success.
1847  */
1848 static unsigned long
1849 qla2x00_port_attributes(scsi_qla_host_t *vha, void *entries,
1850         unsigned int callopt)
1851 {
1852         struct qla_hw_data *ha = vha->hw;
1853         struct init_cb_24xx *icb24 = (void *)ha->init_cb;
1854         struct new_utsname *p_sysid = utsname();
1855         char *hostname = p_sysid ?
1856                 p_sysid->nodename : fc_host_system_hostname(vha->host);
1857         struct ct_fdmi_port_attr *eiter;
1858         uint16_t alen;
1859         unsigned long size = 0;
1860
1861         /* FC4 types. */
1862         eiter = entries + size;
1863         eiter->type = cpu_to_be16(FDMI_PORT_FC4_TYPES);
1864         eiter->a.fc4_types[0] = 0x00;
1865         eiter->a.fc4_types[1] = 0x00;
1866         eiter->a.fc4_types[2] = 0x01;
1867         eiter->a.fc4_types[3] = 0x00;
1868         alen = sizeof(eiter->a.fc4_types);
1869         alen += FDMI_ATTR_TYPELEN(eiter);
1870         eiter->len = cpu_to_be16(alen);
1871         size += alen;
1872         ql_dbg(ql_dbg_disc, vha, 0x20c0,
1873             "FC4 TYPES = %016llx.\n", *(uint64_t *)eiter->a.fc4_types);
1874         if (vha->flags.nvme_enabled) {
1875                 eiter->a.fc4_types[6] = 1;      /* NVMe type 28h */
1876                 ql_dbg(ql_dbg_disc, vha, 0x211f,
1877                     "NVME FC4 Type = %02x 0x0 0x0 0x0 0x0 0x0.\n",
1878                     eiter->a.fc4_types[6]);
1879         }
1880         /* Supported speed. */
1881         eiter = entries + size;
1882         eiter->type = cpu_to_be16(FDMI_PORT_SUPPORT_SPEED);
1883         eiter->a.sup_speed = cpu_to_be32(
1884                 qla25xx_fdmi_port_speed_capability(ha));
1885         alen = sizeof(eiter->a.sup_speed);
1886         alen += FDMI_ATTR_TYPELEN(eiter);
1887         eiter->len = cpu_to_be16(alen);
1888         size += alen;
1889         ql_dbg(ql_dbg_disc, vha, 0x20c1,
1890             "SUPPORTED SPEED = %x.\n", be32_to_cpu(eiter->a.sup_speed));
1891         /* Current speed. */
1892         eiter = entries + size;
1893         eiter->type = cpu_to_be16(FDMI_PORT_CURRENT_SPEED);
1894         eiter->a.cur_speed = cpu_to_be32(
1895                 qla25xx_fdmi_port_speed_currently(ha));
1896         alen = sizeof(eiter->a.cur_speed);
1897         alen += FDMI_ATTR_TYPELEN(eiter);
1898         eiter->len = cpu_to_be16(alen);
1899         size += alen;
1900         ql_dbg(ql_dbg_disc, vha, 0x20c2,
1901             "CURRENT SPEED = %x.\n", be32_to_cpu(eiter->a.cur_speed));
1902         /* Max frame size. */
1903         eiter = entries + size;
1904         eiter->type = cpu_to_be16(FDMI_PORT_MAX_FRAME_SIZE);
1905         eiter->a.max_frame_size = cpu_to_be32(le16_to_cpu(IS_FWI2_CAPABLE(ha) ?
1906                 icb24->frame_payload_size : ha->init_cb->frame_payload_size));
1907         alen = sizeof(eiter->a.max_frame_size);
1908         alen += FDMI_ATTR_TYPELEN(eiter);
1909         eiter->len = cpu_to_be16(alen);
1910         size += alen;
1911         ql_dbg(ql_dbg_disc, vha, 0x20c3,
1912             "MAX FRAME SIZE = %x.\n", be32_to_cpu(eiter->a.max_frame_size));
1913         /* OS device name. */
1914         eiter = entries + size;
1915         eiter->type = cpu_to_be16(FDMI_PORT_OS_DEVICE_NAME);
1916         alen = scnprintf(
1917                 eiter->a.os_dev_name, sizeof(eiter->a.os_dev_name),
1918                 "%s:host%lu", QLA2XXX_DRIVER_NAME, vha->host_no);
1919         alen += FDMI_ATTR_ALIGNMENT(alen);
1920         alen += FDMI_ATTR_TYPELEN(eiter);
1921         eiter->len = cpu_to_be16(alen);
1922         size += alen;
1923         ql_dbg(ql_dbg_disc, vha, 0x20c4,
1924             "OS DEVICE NAME = %s.\n", eiter->a.os_dev_name);
1925         /* Hostname. */
1926         eiter = entries + size;
1927         eiter->type = cpu_to_be16(FDMI_PORT_HOST_NAME);
1928         if (!*hostname || !strncmp(hostname, "(none)", 6))
1929                 hostname = "Linux-default";
1930         alen = scnprintf(
1931                 eiter->a.host_name, sizeof(eiter->a.host_name),
1932                 "%s", hostname);
1933         alen += FDMI_ATTR_ALIGNMENT(alen);
1934         alen += FDMI_ATTR_TYPELEN(eiter);
1935         eiter->len = cpu_to_be16(alen);
1936         size += alen;
1937         ql_dbg(ql_dbg_disc, vha, 0x20c5,
1938             "HOSTNAME = %s.\n", eiter->a.host_name);
1939
1940         if (callopt == CALLOPT_FDMI1)
1941                 goto done;
1942
1943         /* Node Name */
1944         eiter = entries + size;
1945         eiter->type = cpu_to_be16(FDMI_PORT_NODE_NAME);
1946         memcpy(eiter->a.node_name, vha->node_name, sizeof(eiter->a.node_name));
1947         alen = sizeof(eiter->a.node_name);
1948         alen += FDMI_ATTR_TYPELEN(eiter);
1949         eiter->len = cpu_to_be16(alen);
1950         size += alen;
1951         ql_dbg(ql_dbg_disc, vha, 0x20c6,
1952             "NODENAME = %016llx.\n", wwn_to_u64(eiter->a.node_name));
1953
1954         /* Port Name */
1955         eiter = entries + size;
1956         eiter->type = cpu_to_be16(FDMI_PORT_NAME);
1957         memcpy(eiter->a.port_name, vha->port_name, sizeof(eiter->a.port_name));
1958         alen = sizeof(eiter->a.port_name);
1959         alen += FDMI_ATTR_TYPELEN(eiter);
1960         eiter->len = cpu_to_be16(alen);
1961         size += alen;
1962         ql_dbg(ql_dbg_disc, vha, 0x20c7,
1963             "PORTNAME = %016llx.\n", wwn_to_u64(eiter->a.port_name));
1964
1965         /* Port Symbolic Name */
1966         eiter = entries + size;
1967         eiter->type = cpu_to_be16(FDMI_PORT_SYM_NAME);
1968         alen = qla2x00_get_sym_node_name(vha, eiter->a.port_sym_name,
1969             sizeof(eiter->a.port_sym_name));
1970         alen += FDMI_ATTR_ALIGNMENT(alen);
1971         alen += FDMI_ATTR_TYPELEN(eiter);
1972         eiter->len = cpu_to_be16(alen);
1973         size += alen;
1974         ql_dbg(ql_dbg_disc, vha, 0x20c8,
1975             "PORT SYMBOLIC NAME = %s\n", eiter->a.port_sym_name);
1976
1977         /* Port Type */
1978         eiter = entries + size;
1979         eiter->type = cpu_to_be16(FDMI_PORT_TYPE);
1980         eiter->a.port_type = cpu_to_be32(NS_NX_PORT_TYPE);
1981         alen = sizeof(eiter->a.port_type);
1982         alen += FDMI_ATTR_TYPELEN(eiter);
1983         eiter->len = cpu_to_be16(alen);
1984         size += alen;
1985         ql_dbg(ql_dbg_disc, vha, 0x20c9,
1986             "PORT TYPE = %x.\n", be32_to_cpu(eiter->a.port_type));
1987
1988         /* Supported Class of Service */
1989         eiter = entries + size;
1990         eiter->type = cpu_to_be16(FDMI_PORT_SUPP_COS);
1991         eiter->a.port_supported_cos = cpu_to_be32(FC_CLASS_3);
1992         alen = sizeof(eiter->a.port_supported_cos);
1993         alen += FDMI_ATTR_TYPELEN(eiter);
1994         eiter->len = cpu_to_be16(alen);
1995         size += alen;
1996         ql_dbg(ql_dbg_disc, vha, 0x20ca,
1997             "SUPPORTED COS = %08x\n", be32_to_cpu(eiter->a.port_supported_cos));
1998
1999         /* Port Fabric Name */
2000         eiter = entries + size;
2001         eiter->type = cpu_to_be16(FDMI_PORT_FABRIC_NAME);
2002         memcpy(eiter->a.fabric_name, vha->fabric_node_name,
2003             sizeof(eiter->a.fabric_name));
2004         alen = sizeof(eiter->a.fabric_name);
2005         alen += FDMI_ATTR_TYPELEN(eiter);
2006         eiter->len = cpu_to_be16(alen);
2007         size += alen;
2008         ql_dbg(ql_dbg_disc, vha, 0x20cb,
2009             "FABRIC NAME = %016llx.\n", wwn_to_u64(eiter->a.fabric_name));
2010
2011         /* FC4_type */
2012         eiter = entries + size;
2013         eiter->type = cpu_to_be16(FDMI_PORT_FC4_TYPE);
2014         eiter->a.port_fc4_type[0] = 0x00;
2015         eiter->a.port_fc4_type[1] = 0x00;
2016         eiter->a.port_fc4_type[2] = 0x01;
2017         eiter->a.port_fc4_type[3] = 0x00;
2018         alen = sizeof(eiter->a.port_fc4_type);
2019         alen += FDMI_ATTR_TYPELEN(eiter);
2020         eiter->len = cpu_to_be16(alen);
2021         size += alen;
2022         ql_dbg(ql_dbg_disc, vha, 0x20cc,
2023             "PORT ACTIVE FC4 TYPE = %016llx.\n",
2024             *(uint64_t *)eiter->a.port_fc4_type);
2025
2026         /* Port State */
2027         eiter = entries + size;
2028         eiter->type = cpu_to_be16(FDMI_PORT_STATE);
2029         eiter->a.port_state = cpu_to_be32(2);
2030         alen = sizeof(eiter->a.port_state);
2031         alen += FDMI_ATTR_TYPELEN(eiter);
2032         eiter->len = cpu_to_be16(alen);
2033         size += alen;
2034         ql_dbg(ql_dbg_disc, vha, 0x20cd,
2035             "PORT_STATE = %x.\n", be32_to_cpu(eiter->a.port_state));
2036
2037         /* Number of Ports */
2038         eiter = entries + size;
2039         eiter->type = cpu_to_be16(FDMI_PORT_COUNT);
2040         eiter->a.num_ports = cpu_to_be32(1);
2041         alen = sizeof(eiter->a.num_ports);
2042         alen += FDMI_ATTR_TYPELEN(eiter);
2043         eiter->len = cpu_to_be16(alen);
2044         size += alen;
2045         ql_dbg(ql_dbg_disc, vha, 0x20ce,
2046             "PORT COUNT = %x.\n", be32_to_cpu(eiter->a.num_ports));
2047
2048         /* Port Identifier */
2049         eiter = entries + size;
2050         eiter->type = cpu_to_be16(FDMI_PORT_IDENTIFIER);
2051         eiter->a.port_id = cpu_to_be32(vha->d_id.b24);
2052         alen = sizeof(eiter->a.port_id);
2053         alen += FDMI_ATTR_TYPELEN(eiter);
2054         eiter->len = cpu_to_be16(alen);
2055         size += alen;
2056         ql_dbg(ql_dbg_disc, vha, 0x20cf,
2057             "PORT ID = %x.\n", be32_to_cpu(eiter->a.port_id));
2058
2059         if (callopt == CALLOPT_FDMI2 || !ql2xsmartsan)
2060                 goto done;
2061
2062         /* Smart SAN Service Category (Populate Smart SAN Initiator)*/
2063         eiter = entries + size;
2064         eiter->type = cpu_to_be16(FDMI_SMARTSAN_SERVICE);
2065         alen = scnprintf(
2066                 eiter->a.smartsan_service, sizeof(eiter->a.smartsan_service),
2067                 "%s", "Smart SAN Initiator");
2068         alen += FDMI_ATTR_ALIGNMENT(alen);
2069         alen += FDMI_ATTR_TYPELEN(eiter);
2070         eiter->len = cpu_to_be16(alen);
2071         size += alen;
2072         ql_dbg(ql_dbg_disc, vha, 0x20d0,
2073             "SMARTSAN SERVICE CATEGORY = %s.\n", eiter->a.smartsan_service);
2074
2075         /* Smart SAN GUID (NWWN+PWWN) */
2076         eiter = entries + size;
2077         eiter->type = cpu_to_be16(FDMI_SMARTSAN_GUID);
2078         memcpy(eiter->a.smartsan_guid, vha->node_name, WWN_SIZE);
2079         memcpy(eiter->a.smartsan_guid + WWN_SIZE, vha->port_name, WWN_SIZE);
2080         alen = sizeof(eiter->a.smartsan_guid);
2081         alen += FDMI_ATTR_TYPELEN(eiter);
2082         eiter->len = cpu_to_be16(alen);
2083         size += alen;
2084         ql_dbg(ql_dbg_disc, vha, 0x20d1,
2085             "Smart SAN GUID = %016llx-%016llx\n",
2086             wwn_to_u64(eiter->a.smartsan_guid),
2087             wwn_to_u64(eiter->a.smartsan_guid + WWN_SIZE));
2088
2089         /* Smart SAN Version (populate "Smart SAN Version 1.0") */
2090         eiter = entries + size;
2091         eiter->type = cpu_to_be16(FDMI_SMARTSAN_VERSION);
2092         alen = scnprintf(
2093                 eiter->a.smartsan_version, sizeof(eiter->a.smartsan_version),
2094                 "%s", "Smart SAN Version 2.0");
2095         alen += FDMI_ATTR_ALIGNMENT(alen);
2096         alen += FDMI_ATTR_TYPELEN(eiter);
2097         eiter->len = cpu_to_be16(alen);
2098         size += alen;
2099         ql_dbg(ql_dbg_disc, vha, 0x20d2,
2100             "SMARTSAN VERSION = %s\n", eiter->a.smartsan_version);
2101
2102         /* Smart SAN Product Name (Specify Adapter Model No) */
2103         eiter = entries + size;
2104         eiter->type = cpu_to_be16(FDMI_SMARTSAN_PROD_NAME);
2105         alen = scnprintf(eiter->a.smartsan_prod_name,
2106                 sizeof(eiter->a.smartsan_prod_name),
2107                 "ISP%04x", ha->pdev->device);
2108         alen += FDMI_ATTR_ALIGNMENT(alen);
2109         alen += FDMI_ATTR_TYPELEN(eiter);
2110         eiter->len = cpu_to_be16(alen);
2111         size += alen;
2112         ql_dbg(ql_dbg_disc, vha, 0x20d3,
2113             "SMARTSAN PRODUCT NAME = %s\n", eiter->a.smartsan_prod_name);
2114
2115         /* Smart SAN Port Info (specify: 1=Physical, 2=NPIV, 3=SRIOV) */
2116         eiter = entries + size;
2117         eiter->type = cpu_to_be16(FDMI_SMARTSAN_PORT_INFO);
2118         eiter->a.smartsan_port_info = cpu_to_be32(vha->vp_idx ? 2 : 1);
2119         alen = sizeof(eiter->a.smartsan_port_info);
2120         alen += FDMI_ATTR_TYPELEN(eiter);
2121         eiter->len = cpu_to_be16(alen);
2122         size += alen;
2123         ql_dbg(ql_dbg_disc, vha, 0x20d4,
2124             "SMARTSAN PORT INFO = %x\n", eiter->a.smartsan_port_info);
2125
2126         /* Smart SAN Security Support */
2127         eiter = entries + size;
2128         eiter->type = cpu_to_be16(FDMI_SMARTSAN_SECURITY_SUPPORT);
2129         eiter->a.smartsan_security_support = cpu_to_be32(1);
2130         alen = sizeof(eiter->a.smartsan_security_support);
2131         alen += FDMI_ATTR_TYPELEN(eiter);
2132         eiter->len = cpu_to_be16(alen);
2133         size += alen;
2134         ql_dbg(ql_dbg_disc, vha, 0x20d6,
2135             "SMARTSAN SECURITY SUPPORT = %d\n",
2136             be32_to_cpu(eiter->a.smartsan_security_support));
2137
2138 done:
2139         return size;
2140 }
2141
2142 /**
2143  * qla2x00_fdmi_rhba() - perform RHBA FDMI registration
2144  * @vha: HA context
2145  * @callopt: Option to issue FDMI registration
2146  *
2147  * Returns 0 on success.
2148  */
2149 static int
2150 qla2x00_fdmi_rhba(scsi_qla_host_t *vha, unsigned int callopt)
2151 {
2152         struct qla_hw_data *ha = vha->hw;
2153         unsigned long size = 0;
2154         unsigned int rval, count;
2155         ms_iocb_entry_t *ms_pkt;
2156         struct ct_sns_req *ct_req;
2157         struct ct_sns_rsp *ct_rsp;
2158         void *entries;
2159
2160         count = callopt != CALLOPT_FDMI1 ?
2161             FDMI2_HBA_ATTR_COUNT : FDMI1_HBA_ATTR_COUNT;
2162
2163         size = RHBA_RSP_SIZE;
2164
2165         ql_dbg(ql_dbg_disc, vha, 0x20e0,
2166             "RHBA (callopt=%x count=%u size=%lu).\n", callopt, count, size);
2167
2168         /*   Request size adjusted after CT preparation */
2169         ms_pkt = ha->isp_ops->prep_ms_fdmi_iocb(vha, 0, size);
2170
2171         /* Prepare CT request */
2172         ct_req = qla2x00_prep_ct_fdmi_req(ha->ct_sns, RHBA_CMD, size);
2173         ct_rsp = &ha->ct_sns->p.rsp;
2174
2175         /* Prepare FDMI command entries */
2176         memcpy(ct_req->req.rhba.hba_identifier, vha->port_name,
2177             sizeof(ct_req->req.rhba.hba_identifier));
2178         size += sizeof(ct_req->req.rhba.hba_identifier);
2179
2180         ct_req->req.rhba.entry_count = cpu_to_be32(1);
2181         size += sizeof(ct_req->req.rhba.entry_count);
2182
2183         memcpy(ct_req->req.rhba.port_name, vha->port_name,
2184             sizeof(ct_req->req.rhba.port_name));
2185         size += sizeof(ct_req->req.rhba.port_name);
2186
2187         /* Attribute count */
2188         ct_req->req.rhba.attrs.count = cpu_to_be32(count);
2189         size += sizeof(ct_req->req.rhba.attrs.count);
2190
2191         /* Attribute block */
2192         entries = &ct_req->req.rhba.attrs.entry;
2193
2194         size += qla2x00_hba_attributes(vha, entries, callopt);
2195
2196         /* Update MS request size. */
2197         qla2x00_update_ms_fdmi_iocb(vha, size + 16);
2198
2199         ql_dbg(ql_dbg_disc, vha, 0x20e1,
2200             "RHBA %016llx %016llx.\n",
2201             wwn_to_u64(ct_req->req.rhba.hba_identifier),
2202             wwn_to_u64(ct_req->req.rhba.port_name));
2203
2204         ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x20e2,
2205             entries, size);
2206
2207         /* Execute MS IOCB */
2208         rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2209             sizeof(*ha->ms_iocb));
2210         if (rval) {
2211                 ql_dbg(ql_dbg_disc, vha, 0x20e3,
2212                     "RHBA iocb failed (%d).\n", rval);
2213                 return rval;
2214         }
2215
2216         rval = qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "RHBA");
2217         if (rval) {
2218                 if (ct_rsp->header.reason_code == CT_REASON_CANNOT_PERFORM &&
2219                     ct_rsp->header.explanation_code ==
2220                     CT_EXPL_ALREADY_REGISTERED) {
2221                         ql_dbg(ql_dbg_disc, vha, 0x20e4,
2222                             "RHBA already registered.\n");
2223                         return QLA_ALREADY_REGISTERED;
2224                 }
2225
2226                 ql_dbg(ql_dbg_disc, vha, 0x20e5,
2227                     "RHBA failed, CT Reason %#x, CT Explanation %#x\n",
2228                     ct_rsp->header.reason_code,
2229                     ct_rsp->header.explanation_code);
2230                 return rval;
2231         }
2232
2233         ql_dbg(ql_dbg_disc, vha, 0x20e6, "RHBA exiting normally.\n");
2234         return rval;
2235 }
2236
2237
2238 static int
2239 qla2x00_fdmi_dhba(scsi_qla_host_t *vha)
2240 {
2241         int rval;
2242         struct qla_hw_data *ha = vha->hw;
2243         ms_iocb_entry_t *ms_pkt;
2244         struct ct_sns_req *ct_req;
2245         struct ct_sns_rsp *ct_rsp;
2246         /* Issue RPA */
2247         /* Prepare common MS IOCB */
2248         ms_pkt = ha->isp_ops->prep_ms_fdmi_iocb(vha, DHBA_REQ_SIZE,
2249             DHBA_RSP_SIZE);
2250         /* Prepare CT request */
2251         ct_req = qla2x00_prep_ct_fdmi_req(ha->ct_sns, DHBA_CMD, DHBA_RSP_SIZE);
2252         ct_rsp = &ha->ct_sns->p.rsp;
2253         /* Prepare FDMI command arguments -- portname. */
2254         memcpy(ct_req->req.dhba.port_name, vha->port_name, WWN_SIZE);
2255         ql_dbg(ql_dbg_disc, vha, 0x2036,
2256             "DHBA portname = %8phN.\n", ct_req->req.dhba.port_name);
2257         /* Execute MS IOCB */
2258         rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2259             sizeof(ms_iocb_entry_t));
2260         if (rval != QLA_SUCCESS) {
2261                 /*EMPTY*/
2262                 ql_dbg(ql_dbg_disc, vha, 0x2037,
2263                     "DHBA issue IOCB failed (%d).\n", rval);
2264         } else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "DHBA") !=
2265             QLA_SUCCESS) {
2266                 rval = QLA_FUNCTION_FAILED;
2267         } else {
2268                 ql_dbg(ql_dbg_disc, vha, 0x2038,
2269                     "DHBA exiting normally.\n");
2270         }
2271         return rval;
2272 }
2273
2274 /**
2275  * qla2x00_fdmi_rprt() - perform RPRT registration
2276  * @vha: HA context
2277  * @callopt: Option to issue extended or standard FDMI
2278  *           command parameter
2279  *
2280  * Returns 0 on success.
2281  */
2282 static int
2283 qla2x00_fdmi_rprt(scsi_qla_host_t *vha, int callopt)
2284 {
2285         struct scsi_qla_host *base_vha = pci_get_drvdata(vha->hw->pdev);
2286         struct qla_hw_data *ha = vha->hw;
2287         ulong size = 0;
2288         uint rval, count;
2289         ms_iocb_entry_t *ms_pkt;
2290         struct ct_sns_req *ct_req;
2291         struct ct_sns_rsp *ct_rsp;
2292         void *entries;
2293         count = callopt == CALLOPT_FDMI2_SMARTSAN && ql2xsmartsan ?
2294                 FDMI2_SMARTSAN_PORT_ATTR_COUNT :
2295                 callopt != CALLOPT_FDMI1 ?
2296                 FDMI2_PORT_ATTR_COUNT : FDMI1_PORT_ATTR_COUNT;
2297
2298         size = RPRT_RSP_SIZE;
2299         ql_dbg(ql_dbg_disc, vha, 0x20e8,
2300             "RPRT (callopt=%x count=%u size=%lu).\n", callopt, count, size);
2301         /* Request size adjusted after CT preparation */
2302         ms_pkt = ha->isp_ops->prep_ms_fdmi_iocb(vha, 0, size);
2303         /* Prepare CT request */
2304         ct_req = qla2x00_prep_ct_fdmi_req(ha->ct_sns, RPRT_CMD, size);
2305         ct_rsp = &ha->ct_sns->p.rsp;
2306         /* Prepare FDMI command entries */
2307         memcpy(ct_req->req.rprt.hba_identifier, base_vha->port_name,
2308             sizeof(ct_req->req.rprt.hba_identifier));
2309         size += sizeof(ct_req->req.rprt.hba_identifier);
2310         memcpy(ct_req->req.rprt.port_name, vha->port_name,
2311             sizeof(ct_req->req.rprt.port_name));
2312         size += sizeof(ct_req->req.rprt.port_name);
2313         /* Attribute count */
2314         ct_req->req.rprt.attrs.count = cpu_to_be32(count);
2315         size += sizeof(ct_req->req.rprt.attrs.count);
2316         /* Attribute block */
2317         entries = ct_req->req.rprt.attrs.entry;
2318         size += qla2x00_port_attributes(vha, entries, callopt);
2319         /* Update MS request size. */
2320         qla2x00_update_ms_fdmi_iocb(vha, size + 16);
2321         ql_dbg(ql_dbg_disc, vha, 0x20e9,
2322             "RPRT %016llx  %016llx.\n",
2323             wwn_to_u64(ct_req->req.rprt.port_name),
2324             wwn_to_u64(ct_req->req.rprt.port_name));
2325         ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x20ea,
2326             entries, size);
2327         /* Execute MS IOCB */
2328         rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2329             sizeof(*ha->ms_iocb));
2330         if (rval) {
2331                 ql_dbg(ql_dbg_disc, vha, 0x20eb,
2332                     "RPRT iocb failed (%d).\n", rval);
2333                 return rval;
2334         }
2335         rval = qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "RPRT");
2336         if (rval) {
2337                 if (ct_rsp->header.reason_code == CT_REASON_CANNOT_PERFORM &&
2338                     ct_rsp->header.explanation_code ==
2339                     CT_EXPL_ALREADY_REGISTERED) {
2340                         ql_dbg(ql_dbg_disc, vha, 0x20ec,
2341                             "RPRT already registered.\n");
2342                         return QLA_ALREADY_REGISTERED;
2343                 }
2344
2345                 ql_dbg(ql_dbg_disc, vha, 0x20ed,
2346                     "RPRT failed, CT Reason code: %#x, CT Explanation %#x\n",
2347                     ct_rsp->header.reason_code,
2348                     ct_rsp->header.explanation_code);
2349                 return rval;
2350         }
2351         ql_dbg(ql_dbg_disc, vha, 0x20ee, "RPRT exiting normally.\n");
2352         return rval;
2353 }
2354
2355 /**
2356  * qla2x00_fdmi_rpa() - perform RPA registration
2357  * @vha: HA context
2358  * @callopt: Option to issue FDMI registration
2359  *
2360  * Returns 0 on success.
2361  */
2362 static int
2363 qla2x00_fdmi_rpa(scsi_qla_host_t *vha, uint callopt)
2364 {
2365         struct qla_hw_data *ha = vha->hw;
2366         ulong size = 0;
2367         uint rval, count;
2368         ms_iocb_entry_t *ms_pkt;
2369         struct ct_sns_req *ct_req;
2370         struct ct_sns_rsp *ct_rsp;
2371         void *entries;
2372
2373         count =
2374             callopt == CALLOPT_FDMI2_SMARTSAN && ql2xsmartsan ?
2375                 FDMI2_SMARTSAN_PORT_ATTR_COUNT :
2376             callopt != CALLOPT_FDMI1 ?
2377                 FDMI2_PORT_ATTR_COUNT : FDMI1_PORT_ATTR_COUNT;
2378
2379         size =
2380             callopt != CALLOPT_FDMI1 ?
2381                 SMARTSAN_RPA_RSP_SIZE : RPA_RSP_SIZE;
2382
2383         ql_dbg(ql_dbg_disc, vha, 0x20f0,
2384             "RPA (callopt=%x count=%u size=%lu).\n", callopt, count, size);
2385
2386         /* Request size adjusted after CT preparation */
2387         ms_pkt = ha->isp_ops->prep_ms_fdmi_iocb(vha, 0, size);
2388
2389         /* Prepare CT request */
2390         ct_req = qla2x00_prep_ct_fdmi_req(ha->ct_sns, RPA_CMD, size);
2391         ct_rsp = &ha->ct_sns->p.rsp;
2392
2393         /* Prepare FDMI command entries. */
2394         memcpy(ct_req->req.rpa.port_name, vha->port_name,
2395             sizeof(ct_req->req.rpa.port_name));
2396         size += sizeof(ct_req->req.rpa.port_name);
2397
2398         /* Attribute count */
2399         ct_req->req.rpa.attrs.count = cpu_to_be32(count);
2400         size += sizeof(ct_req->req.rpa.attrs.count);
2401
2402         /* Attribute block */
2403         entries = ct_req->req.rpa.attrs.entry;
2404
2405         size += qla2x00_port_attributes(vha, entries, callopt);
2406
2407         /* Update MS request size. */
2408         qla2x00_update_ms_fdmi_iocb(vha, size + 16);
2409
2410         ql_dbg(ql_dbg_disc, vha, 0x20f1,
2411             "RPA %016llx.\n", wwn_to_u64(ct_req->req.rpa.port_name));
2412
2413         ql_dump_buffer(ql_dbg_disc + ql_dbg_buffer, vha, 0x20f2,
2414             entries, size);
2415
2416         /* Execute MS IOCB */
2417         rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2418             sizeof(*ha->ms_iocb));
2419         if (rval) {
2420                 ql_dbg(ql_dbg_disc, vha, 0x20f3,
2421                     "RPA iocb failed (%d).\n", rval);
2422                 return rval;
2423         }
2424
2425         rval = qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp, "RPA");
2426         if (rval) {
2427                 if (ct_rsp->header.reason_code == CT_REASON_CANNOT_PERFORM &&
2428                     ct_rsp->header.explanation_code ==
2429                     CT_EXPL_ALREADY_REGISTERED) {
2430                         ql_dbg(ql_dbg_disc, vha, 0x20f4,
2431                             "RPA already registered.\n");
2432                         return QLA_ALREADY_REGISTERED;
2433                 }
2434
2435                 ql_dbg(ql_dbg_disc, vha, 0x20f5,
2436                     "RPA failed, CT Reason code: %#x, CT Explanation %#x\n",
2437                     ct_rsp->header.reason_code,
2438                     ct_rsp->header.explanation_code);
2439                 return rval;
2440         }
2441
2442         ql_dbg(ql_dbg_disc, vha, 0x20f6, "RPA exiting normally.\n");
2443         return rval;
2444 }
2445
2446 /**
2447  * qla2x00_fdmi_register() -
2448  * @vha: HA context
2449  *
2450  * Returns 0 on success.
2451  */
2452 int
2453 qla2x00_fdmi_register(scsi_qla_host_t *vha)
2454 {
2455         int rval = QLA_SUCCESS;
2456         struct qla_hw_data *ha = vha->hw;
2457
2458         if (IS_QLA2100(ha) || IS_QLA2200(ha) ||
2459             IS_QLAFX00(ha))
2460                 return rval;
2461
2462         rval = qla2x00_mgmt_svr_login(vha);
2463         if (rval)
2464                 return rval;
2465
2466         /* For npiv/vport send rprt only */
2467         if (vha->vp_idx) {
2468                 if (ql2xsmartsan)
2469                         rval = qla2x00_fdmi_rprt(vha, CALLOPT_FDMI2_SMARTSAN);
2470                 if (rval || !ql2xsmartsan)
2471                         rval = qla2x00_fdmi_rprt(vha, CALLOPT_FDMI2);
2472                 if (rval)
2473                         rval = qla2x00_fdmi_rprt(vha, CALLOPT_FDMI1);
2474
2475                 return rval;
2476         }
2477
2478         /* Try fdmi2 first, if fails then try fdmi1 */
2479         rval = qla2x00_fdmi_rhba(vha, CALLOPT_FDMI2);
2480         if (rval) {
2481                 if (rval != QLA_ALREADY_REGISTERED)
2482                         goto try_fdmi;
2483
2484                 rval = qla2x00_fdmi_dhba(vha);
2485                 if (rval)
2486                         goto try_fdmi;
2487
2488                 rval = qla2x00_fdmi_rhba(vha, CALLOPT_FDMI2);
2489                 if (rval)
2490                         goto try_fdmi;
2491         }
2492
2493         if (ql2xsmartsan)
2494                 rval = qla2x00_fdmi_rpa(vha, CALLOPT_FDMI2_SMARTSAN);
2495         if (rval || !ql2xsmartsan)
2496                 rval = qla2x00_fdmi_rpa(vha, CALLOPT_FDMI2);
2497         if (rval)
2498                 goto try_fdmi;
2499
2500         return rval;
2501
2502 try_fdmi:
2503         rval = qla2x00_fdmi_rhba(vha, CALLOPT_FDMI1);
2504         if (rval) {
2505                 if (rval != QLA_ALREADY_REGISTERED)
2506                         return rval;
2507
2508                 rval = qla2x00_fdmi_dhba(vha);
2509                 if (rval)
2510                         return rval;
2511
2512                 rval = qla2x00_fdmi_rhba(vha, CALLOPT_FDMI1);
2513                 if (rval)
2514                         return rval;
2515         }
2516
2517         rval = qla2x00_fdmi_rpa(vha, CALLOPT_FDMI1);
2518
2519         return rval;
2520 }
2521
2522 /**
2523  * qla2x00_gfpn_id() - SNS Get Fabric Port Name (GFPN_ID) query.
2524  * @vha: HA context
2525  * @list: switch info entries to populate
2526  *
2527  * Returns 0 on success.
2528  */
2529 int
2530 qla2x00_gfpn_id(scsi_qla_host_t *vha, sw_info_t *list)
2531 {
2532         int             rval = QLA_SUCCESS;
2533         uint16_t        i;
2534         struct qla_hw_data *ha = vha->hw;
2535         ms_iocb_entry_t *ms_pkt;
2536         struct ct_sns_req       *ct_req;
2537         struct ct_sns_rsp       *ct_rsp;
2538         struct ct_arg arg;
2539
2540         if (!IS_IIDMA_CAPABLE(ha))
2541                 return QLA_FUNCTION_FAILED;
2542
2543         arg.iocb = ha->ms_iocb;
2544         arg.req_dma = ha->ct_sns_dma;
2545         arg.rsp_dma = ha->ct_sns_dma;
2546         arg.req_size = GFPN_ID_REQ_SIZE;
2547         arg.rsp_size = GFPN_ID_RSP_SIZE;
2548         arg.nport_handle = NPH_SNS;
2549
2550         for (i = 0; i < ha->max_fibre_devices; i++) {
2551                 /* Issue GFPN_ID */
2552                 /* Prepare common MS IOCB */
2553                 ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
2554
2555                 /* Prepare CT request */
2556                 ct_req = qla2x00_prep_ct_req(ha->ct_sns, GFPN_ID_CMD,
2557                     GFPN_ID_RSP_SIZE);
2558                 ct_rsp = &ha->ct_sns->p.rsp;
2559
2560                 /* Prepare CT arguments -- port_id */
2561                 ct_req->req.port_id.port_id = port_id_to_be_id(list[i].d_id);
2562
2563                 /* Execute MS IOCB */
2564                 rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2565                     sizeof(ms_iocb_entry_t));
2566                 if (rval != QLA_SUCCESS) {
2567                         /*EMPTY*/
2568                         ql_dbg(ql_dbg_disc, vha, 0x2023,
2569                             "GFPN_ID issue IOCB failed (%d).\n", rval);
2570                         break;
2571                 } else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp,
2572                     "GFPN_ID") != QLA_SUCCESS) {
2573                         rval = QLA_FUNCTION_FAILED;
2574                         break;
2575                 } else {
2576                         /* Save fabric portname */
2577                         memcpy(list[i].fabric_port_name,
2578                             ct_rsp->rsp.gfpn_id.port_name, WWN_SIZE);
2579                 }
2580
2581                 /* Last device exit. */
2582                 if (list[i].d_id.b.rsvd_1 != 0)
2583                         break;
2584         }
2585
2586         return (rval);
2587 }
2588
2589
2590 static inline struct ct_sns_req *
2591 qla24xx_prep_ct_fm_req(struct ct_sns_pkt *p, uint16_t cmd,
2592     uint16_t rsp_size)
2593 {
2594         memset(p, 0, sizeof(struct ct_sns_pkt));
2595
2596         p->p.req.header.revision = 0x01;
2597         p->p.req.header.gs_type = 0xFA;
2598         p->p.req.header.gs_subtype = 0x01;
2599         p->p.req.command = cpu_to_be16(cmd);
2600         p->p.req.max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
2601
2602         return &p->p.req;
2603 }
2604
2605 static uint16_t
2606 qla2x00_port_speed_capability(uint16_t speed)
2607 {
2608         switch (speed) {
2609         case BIT_15:
2610                 return PORT_SPEED_1GB;
2611         case BIT_14:
2612                 return PORT_SPEED_2GB;
2613         case BIT_13:
2614                 return PORT_SPEED_4GB;
2615         case BIT_12:
2616                 return PORT_SPEED_10GB;
2617         case BIT_11:
2618                 return PORT_SPEED_8GB;
2619         case BIT_10:
2620                 return PORT_SPEED_16GB;
2621         case BIT_8:
2622                 return PORT_SPEED_32GB;
2623         case BIT_7:
2624                 return PORT_SPEED_64GB;
2625         default:
2626                 return PORT_SPEED_UNKNOWN;
2627         }
2628 }
2629
2630 /**
2631  * qla2x00_gpsc() - FCS Get Port Speed Capabilities (GPSC) query.
2632  * @vha: HA context
2633  * @list: switch info entries to populate
2634  *
2635  * Returns 0 on success.
2636  */
2637 int
2638 qla2x00_gpsc(scsi_qla_host_t *vha, sw_info_t *list)
2639 {
2640         int             rval;
2641         uint16_t        i;
2642         struct qla_hw_data *ha = vha->hw;
2643         ms_iocb_entry_t *ms_pkt;
2644         struct ct_sns_req       *ct_req;
2645         struct ct_sns_rsp       *ct_rsp;
2646         struct ct_arg arg;
2647
2648         if (!IS_IIDMA_CAPABLE(ha))
2649                 return QLA_FUNCTION_FAILED;
2650         if (!ha->flags.gpsc_supported)
2651                 return QLA_FUNCTION_FAILED;
2652
2653         rval = qla2x00_mgmt_svr_login(vha);
2654         if (rval)
2655                 return rval;
2656
2657         arg.iocb = ha->ms_iocb;
2658         arg.req_dma = ha->ct_sns_dma;
2659         arg.rsp_dma = ha->ct_sns_dma;
2660         arg.req_size = GPSC_REQ_SIZE;
2661         arg.rsp_size = GPSC_RSP_SIZE;
2662         arg.nport_handle = vha->mgmt_svr_loop_id;
2663
2664         for (i = 0; i < ha->max_fibre_devices; i++) {
2665                 /* Issue GFPN_ID */
2666                 /* Prepare common MS IOCB */
2667                 ms_pkt = qla24xx_prep_ms_iocb(vha, &arg);
2668
2669                 /* Prepare CT request */
2670                 ct_req = qla24xx_prep_ct_fm_req(ha->ct_sns, GPSC_CMD,
2671                     GPSC_RSP_SIZE);
2672                 ct_rsp = &ha->ct_sns->p.rsp;
2673
2674                 /* Prepare CT arguments -- port_name */
2675                 memcpy(ct_req->req.gpsc.port_name, list[i].fabric_port_name,
2676                     WWN_SIZE);
2677
2678                 /* Execute MS IOCB */
2679                 rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2680                     sizeof(ms_iocb_entry_t));
2681                 if (rval != QLA_SUCCESS) {
2682                         /*EMPTY*/
2683                         ql_dbg(ql_dbg_disc, vha, 0x2059,
2684                             "GPSC issue IOCB failed (%d).\n", rval);
2685                 } else if ((rval = qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp,
2686                     "GPSC")) != QLA_SUCCESS) {
2687                         /* FM command unsupported? */
2688                         if (rval == QLA_INVALID_COMMAND &&
2689                             (ct_rsp->header.reason_code ==
2690                                 CT_REASON_INVALID_COMMAND_CODE ||
2691                              ct_rsp->header.reason_code ==
2692                                 CT_REASON_COMMAND_UNSUPPORTED)) {
2693                                 ql_dbg(ql_dbg_disc, vha, 0x205a,
2694                                     "GPSC command unsupported, disabling "
2695                                     "query.\n");
2696                                 ha->flags.gpsc_supported = 0;
2697                                 rval = QLA_FUNCTION_FAILED;
2698                                 break;
2699                         }
2700                         rval = QLA_FUNCTION_FAILED;
2701                 } else {
2702                         list->fp_speed = qla2x00_port_speed_capability(
2703                             be16_to_cpu(ct_rsp->rsp.gpsc.speed));
2704                         ql_dbg(ql_dbg_disc, vha, 0x205b,
2705                             "GPSC ext entry - fpn "
2706                             "%8phN speeds=%04x speed=%04x.\n",
2707                             list[i].fabric_port_name,
2708                             be16_to_cpu(ct_rsp->rsp.gpsc.speeds),
2709                             be16_to_cpu(ct_rsp->rsp.gpsc.speed));
2710                 }
2711
2712                 /* Last device exit. */
2713                 if (list[i].d_id.b.rsvd_1 != 0)
2714                         break;
2715         }
2716
2717         return (rval);
2718 }
2719
2720 /**
2721  * qla2x00_gff_id() - SNS Get FC-4 Features (GFF_ID) query.
2722  *
2723  * @vha: HA context
2724  * @list: switch info entries to populate
2725  *
2726  */
2727 void
2728 qla2x00_gff_id(scsi_qla_host_t *vha, sw_info_t *list)
2729 {
2730         int             rval;
2731         uint16_t        i;
2732
2733         ms_iocb_entry_t *ms_pkt;
2734         struct ct_sns_req       *ct_req;
2735         struct ct_sns_rsp       *ct_rsp;
2736         struct qla_hw_data *ha = vha->hw;
2737         uint8_t fcp_scsi_features = 0, nvme_features = 0;
2738         struct ct_arg arg;
2739
2740         for (i = 0; i < ha->max_fibre_devices; i++) {
2741                 /* Set default FC4 Type as UNKNOWN so the default is to
2742                  * Process this port */
2743                 list[i].fc4_type = 0;
2744
2745                 /* Do not attempt GFF_ID if we are not FWI_2 capable */
2746                 if (!IS_FWI2_CAPABLE(ha))
2747                         continue;
2748
2749                 arg.iocb = ha->ms_iocb;
2750                 arg.req_dma = ha->ct_sns_dma;
2751                 arg.rsp_dma = ha->ct_sns_dma;
2752                 arg.req_size = GFF_ID_REQ_SIZE;
2753                 arg.rsp_size = GFF_ID_RSP_SIZE;
2754                 arg.nport_handle = NPH_SNS;
2755
2756                 /* Prepare common MS IOCB */
2757                 ms_pkt = ha->isp_ops->prep_ms_iocb(vha, &arg);
2758
2759                 /* Prepare CT request */
2760                 ct_req = qla2x00_prep_ct_req(ha->ct_sns, GFF_ID_CMD,
2761                     GFF_ID_RSP_SIZE);
2762                 ct_rsp = &ha->ct_sns->p.rsp;
2763
2764                 /* Prepare CT arguments -- port_id */
2765                 ct_req->req.port_id.port_id = port_id_to_be_id(list[i].d_id);
2766
2767                 /* Execute MS IOCB */
2768                 rval = qla2x00_issue_iocb(vha, ha->ms_iocb, ha->ms_iocb_dma,
2769                    sizeof(ms_iocb_entry_t));
2770
2771                 if (rval != QLA_SUCCESS) {
2772                         ql_dbg(ql_dbg_disc, vha, 0x205c,
2773                             "GFF_ID issue IOCB failed (%d).\n", rval);
2774                 } else if (qla2x00_chk_ms_status(vha, ms_pkt, ct_rsp,
2775                                "GFF_ID") != QLA_SUCCESS) {
2776                         ql_dbg(ql_dbg_disc, vha, 0x205d,
2777                             "GFF_ID IOCB status had a failure status code.\n");
2778                 } else {
2779                         fcp_scsi_features =
2780                            ct_rsp->rsp.gff_id.fc4_features[GFF_FCP_SCSI_OFFSET];
2781                         fcp_scsi_features &= 0x0f;
2782
2783                         if (fcp_scsi_features) {
2784                                 list[i].fc4_type = FS_FC4TYPE_FCP;
2785                                 list[i].fc4_features = fcp_scsi_features;
2786                         }
2787
2788                         nvme_features =
2789                             ct_rsp->rsp.gff_id.fc4_features[GFF_NVME_OFFSET];
2790                         nvme_features &= 0xf;
2791
2792                         if (nvme_features) {
2793                                 list[i].fc4_type |= FS_FC4TYPE_NVME;
2794                                 list[i].fc4_features = nvme_features;
2795                         }
2796                 }
2797
2798                 /* Last device exit. */
2799                 if (list[i].d_id.b.rsvd_1 != 0)
2800                         break;
2801         }
2802 }
2803
2804 int qla24xx_post_gpsc_work(struct scsi_qla_host *vha, fc_port_t *fcport)
2805 {
2806         struct qla_work_evt *e;
2807
2808         e = qla2x00_alloc_work(vha, QLA_EVT_GPSC);
2809         if (!e)
2810                 return QLA_FUNCTION_FAILED;
2811
2812         e->u.fcport.fcport = fcport;
2813         return qla2x00_post_work(vha, e);
2814 }
2815
2816 void qla24xx_handle_gpsc_event(scsi_qla_host_t *vha, struct event_arg *ea)
2817 {
2818         struct fc_port *fcport = ea->fcport;
2819
2820         ql_dbg(ql_dbg_disc, vha, 0x20d8,
2821             "%s %8phC DS %d LS %d rc %d login %d|%d rscn %d|%d lid %d\n",
2822             __func__, fcport->port_name, fcport->disc_state,
2823             fcport->fw_login_state, ea->rc, ea->sp->gen2, fcport->login_gen,
2824             ea->sp->gen2, fcport->rscn_gen|ea->sp->gen1, fcport->loop_id);
2825
2826         if (fcport->disc_state == DSC_DELETE_PEND)
2827                 return;
2828
2829         if (ea->sp->gen2 != fcport->login_gen) {
2830                 /* target side must have changed it. */
2831                 ql_dbg(ql_dbg_disc, vha, 0x20d3,
2832                     "%s %8phC generation changed\n",
2833                     __func__, fcport->port_name);
2834                 return;
2835         } else if (ea->sp->gen1 != fcport->rscn_gen) {
2836                 return;
2837         }
2838
2839         qla_post_iidma_work(vha, fcport);
2840 }
2841
2842 static void qla24xx_async_gpsc_sp_done(srb_t *sp, int res)
2843 {
2844         struct scsi_qla_host *vha = sp->vha;
2845         struct qla_hw_data *ha = vha->hw;
2846         fc_port_t *fcport = sp->fcport;
2847         struct ct_sns_rsp       *ct_rsp;
2848         struct event_arg ea;
2849
2850         ct_rsp = &fcport->ct_desc.ct_sns->p.rsp;
2851
2852         ql_dbg(ql_dbg_disc, vha, 0x2053,
2853             "Async done-%s res %x, WWPN %8phC \n",
2854             sp->name, res, fcport->port_name);
2855
2856         fcport->flags &= ~(FCF_ASYNC_SENT | FCF_ASYNC_ACTIVE);
2857
2858         if (res == QLA_FUNCTION_TIMEOUT)
2859                 goto done;
2860
2861         if (res == (DID_ERROR << 16)) {
2862                 /* entry status error */
2863                 goto done;
2864         } else if (res) {
2865                 if ((ct_rsp->header.reason_code ==
2866                          CT_REASON_INVALID_COMMAND_CODE) ||
2867                         (ct_rsp->header.reason_code ==
2868                         CT_REASON_COMMAND_UNSUPPORTED)) {
2869                         ql_dbg(ql_dbg_disc, vha, 0x2019,
2870                             "GPSC command unsupported, disabling query.\n");
2871                         ha->flags.gpsc_supported = 0;
2872                         goto done;
2873                 }
2874         } else {
2875                 fcport->fp_speed = qla2x00_port_speed_capability(
2876                     be16_to_cpu(ct_rsp->rsp.gpsc.speed));
2877
2878                 ql_dbg(ql_dbg_disc, vha, 0x2054,
2879                     "Async-%s OUT WWPN %8phC speeds=%04x speed=%04x.\n",
2880                     sp->name, fcport->fabric_port_name,
2881                     be16_to_cpu(ct_rsp->rsp.gpsc.speeds),
2882                     be16_to_cpu(ct_rsp->rsp.gpsc.speed));
2883         }
2884         memset(&ea, 0, sizeof(ea));
2885         ea.rc = res;
2886         ea.fcport = fcport;
2887         ea.sp = sp;
2888         qla24xx_handle_gpsc_event(vha, &ea);
2889
2890 done:
2891         sp->free(sp);
2892 }
2893
2894 int qla24xx_async_gpsc(scsi_qla_host_t *vha, fc_port_t *fcport)
2895 {
2896         int rval = QLA_FUNCTION_FAILED;
2897         struct ct_sns_req       *ct_req;
2898         srb_t *sp;
2899
2900         if (!vha->flags.online || (fcport->flags & FCF_ASYNC_SENT))
2901                 return rval;
2902
2903         sp = qla2x00_get_sp(vha, fcport, GFP_KERNEL);
2904         if (!sp)
2905                 goto done;
2906
2907         sp->type = SRB_CT_PTHRU_CMD;
2908         sp->name = "gpsc";
2909         sp->gen1 = fcport->rscn_gen;
2910         sp->gen2 = fcport->login_gen;
2911
2912         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
2913
2914         /* CT_IU preamble  */
2915         ct_req = qla24xx_prep_ct_fm_req(fcport->ct_desc.ct_sns, GPSC_CMD,
2916                 GPSC_RSP_SIZE);
2917
2918         /* GPSC req */
2919         memcpy(ct_req->req.gpsc.port_name, fcport->fabric_port_name,
2920                 WWN_SIZE);
2921
2922         sp->u.iocb_cmd.u.ctarg.req = fcport->ct_desc.ct_sns;
2923         sp->u.iocb_cmd.u.ctarg.req_dma = fcport->ct_desc.ct_sns_dma;
2924         sp->u.iocb_cmd.u.ctarg.rsp = fcport->ct_desc.ct_sns;
2925         sp->u.iocb_cmd.u.ctarg.rsp_dma = fcport->ct_desc.ct_sns_dma;
2926         sp->u.iocb_cmd.u.ctarg.req_size = GPSC_REQ_SIZE;
2927         sp->u.iocb_cmd.u.ctarg.rsp_size = GPSC_RSP_SIZE;
2928         sp->u.iocb_cmd.u.ctarg.nport_handle = vha->mgmt_svr_loop_id;
2929
2930         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
2931         sp->done = qla24xx_async_gpsc_sp_done;
2932
2933         ql_dbg(ql_dbg_disc, vha, 0x205e,
2934             "Async-%s %8phC hdl=%x loopid=%x portid=%02x%02x%02x.\n",
2935             sp->name, fcport->port_name, sp->handle,
2936             fcport->loop_id, fcport->d_id.b.domain,
2937             fcport->d_id.b.area, fcport->d_id.b.al_pa);
2938
2939         rval = qla2x00_start_sp(sp);
2940         if (rval != QLA_SUCCESS)
2941                 goto done_free_sp;
2942         return rval;
2943
2944 done_free_sp:
2945         sp->free(sp);
2946 done:
2947         return rval;
2948 }
2949
2950 int qla24xx_post_gpnid_work(struct scsi_qla_host *vha, port_id_t *id)
2951 {
2952         struct qla_work_evt *e;
2953
2954         if (test_bit(UNLOADING, &vha->dpc_flags) ||
2955             (vha->vp_idx && test_bit(VPORT_DELETE, &vha->dpc_flags)))
2956                 return 0;
2957
2958         e = qla2x00_alloc_work(vha, QLA_EVT_GPNID);
2959         if (!e)
2960                 return QLA_FUNCTION_FAILED;
2961
2962         e->u.gpnid.id = *id;
2963         return qla2x00_post_work(vha, e);
2964 }
2965
2966 void qla24xx_sp_unmap(scsi_qla_host_t *vha, srb_t *sp)
2967 {
2968         struct srb_iocb *c = &sp->u.iocb_cmd;
2969
2970         switch (sp->type) {
2971         case SRB_ELS_DCMD:
2972                 qla2x00_els_dcmd2_free(vha, &c->u.els_plogi);
2973                 break;
2974         case SRB_CT_PTHRU_CMD:
2975         default:
2976                 if (sp->u.iocb_cmd.u.ctarg.req) {
2977                         dma_free_coherent(&vha->hw->pdev->dev,
2978                             sp->u.iocb_cmd.u.ctarg.req_allocated_size,
2979                             sp->u.iocb_cmd.u.ctarg.req,
2980                             sp->u.iocb_cmd.u.ctarg.req_dma);
2981                         sp->u.iocb_cmd.u.ctarg.req = NULL;
2982                 }
2983
2984                 if (sp->u.iocb_cmd.u.ctarg.rsp) {
2985                         dma_free_coherent(&vha->hw->pdev->dev,
2986                             sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
2987                             sp->u.iocb_cmd.u.ctarg.rsp,
2988                             sp->u.iocb_cmd.u.ctarg.rsp_dma);
2989                         sp->u.iocb_cmd.u.ctarg.rsp = NULL;
2990                 }
2991                 break;
2992         }
2993
2994         sp->free(sp);
2995 }
2996
2997 void qla24xx_handle_gpnid_event(scsi_qla_host_t *vha, struct event_arg *ea)
2998 {
2999         fc_port_t *fcport, *conflict, *t;
3000         u16 data[2];
3001
3002         ql_dbg(ql_dbg_disc, vha, 0xffff,
3003             "%s %d port_id: %06x\n",
3004             __func__, __LINE__, ea->id.b24);
3005
3006         if (ea->rc) {
3007                 /* cable is disconnected */
3008                 list_for_each_entry_safe(fcport, t, &vha->vp_fcports, list) {
3009                         if (fcport->d_id.b24 == ea->id.b24)
3010                                 fcport->scan_state = QLA_FCPORT_SCAN;
3011
3012                         qlt_schedule_sess_for_deletion(fcport);
3013                 }
3014         } else {
3015                 /* cable is connected */
3016                 fcport = qla2x00_find_fcport_by_wwpn(vha, ea->port_name, 1);
3017                 if (fcport) {
3018                         list_for_each_entry_safe(conflict, t, &vha->vp_fcports,
3019                             list) {
3020                                 if ((conflict->d_id.b24 == ea->id.b24) &&
3021                                     (fcport != conflict))
3022                                         /*
3023                                          * 2 fcports with conflict Nport ID or
3024                                          * an existing fcport is having nport ID
3025                                          * conflict with new fcport.
3026                                          */
3027
3028                                         conflict->scan_state = QLA_FCPORT_SCAN;
3029
3030                                 qlt_schedule_sess_for_deletion(conflict);
3031                         }
3032
3033                         fcport->scan_needed = 0;
3034                         fcport->rscn_gen++;
3035                         fcport->scan_state = QLA_FCPORT_FOUND;
3036                         fcport->flags |= FCF_FABRIC_DEVICE;
3037                         if (fcport->login_retry == 0) {
3038                                 fcport->login_retry =
3039                                         vha->hw->login_retry_count;
3040                                 ql_dbg(ql_dbg_disc, vha, 0xffff,
3041                                     "Port login retry %8phN, lid 0x%04x cnt=%d.\n",
3042                                     fcport->port_name, fcport->loop_id,
3043                                     fcport->login_retry);
3044                         }
3045                         switch (fcport->disc_state) {
3046                         case DSC_LOGIN_COMPLETE:
3047                                 /* recheck session is still intact. */
3048                                 ql_dbg(ql_dbg_disc, vha, 0x210d,
3049                                     "%s %d %8phC revalidate session with ADISC\n",
3050                                     __func__, __LINE__, fcport->port_name);
3051                                 data[0] = data[1] = 0;
3052                                 qla2x00_post_async_adisc_work(vha, fcport,
3053                                     data);
3054                                 break;
3055                         case DSC_DELETED:
3056                                 ql_dbg(ql_dbg_disc, vha, 0x210d,
3057                                     "%s %d %8phC login\n", __func__, __LINE__,
3058                                     fcport->port_name);
3059                                 fcport->d_id = ea->id;
3060                                 qla24xx_fcport_handle_login(vha, fcport);
3061                                 break;
3062                         case DSC_DELETE_PEND:
3063                                 fcport->d_id = ea->id;
3064                                 break;
3065                         default:
3066                                 fcport->d_id = ea->id;
3067                                 break;
3068                         }
3069                 } else {
3070                         list_for_each_entry_safe(conflict, t, &vha->vp_fcports,
3071                             list) {
3072                                 if (conflict->d_id.b24 == ea->id.b24) {
3073                                         /* 2 fcports with conflict Nport ID or
3074                                          * an existing fcport is having nport ID
3075                                          * conflict with new fcport.
3076                                          */
3077                                         ql_dbg(ql_dbg_disc, vha, 0xffff,
3078                                             "%s %d %8phC DS %d\n",
3079                                             __func__, __LINE__,
3080                                             conflict->port_name,
3081                                             conflict->disc_state);
3082
3083                                         conflict->scan_state = QLA_FCPORT_SCAN;
3084                                         qlt_schedule_sess_for_deletion(conflict);
3085                                 }
3086                         }
3087
3088                         /* create new fcport */
3089                         ql_dbg(ql_dbg_disc, vha, 0x2065,
3090                             "%s %d %8phC post new sess\n",
3091                             __func__, __LINE__, ea->port_name);
3092                         qla24xx_post_newsess_work(vha, &ea->id,
3093                             ea->port_name, NULL, NULL, 0);
3094                 }
3095         }
3096 }
3097
3098 static void qla2x00_async_gpnid_sp_done(srb_t *sp, int res)
3099 {
3100         struct scsi_qla_host *vha = sp->vha;
3101         struct ct_sns_req *ct_req =
3102             (struct ct_sns_req *)sp->u.iocb_cmd.u.ctarg.req;
3103         struct ct_sns_rsp *ct_rsp =
3104             (struct ct_sns_rsp *)sp->u.iocb_cmd.u.ctarg.rsp;
3105         struct event_arg ea;
3106         struct qla_work_evt *e;
3107         unsigned long flags;
3108
3109         if (res)
3110                 ql_dbg(ql_dbg_disc, vha, 0x2066,
3111                     "Async done-%s fail res %x rscn gen %d ID %3phC. %8phC\n",
3112                     sp->name, res, sp->gen1, &ct_req->req.port_id.port_id,
3113                     ct_rsp->rsp.gpn_id.port_name);
3114         else
3115                 ql_dbg(ql_dbg_disc, vha, 0x2066,
3116                     "Async done-%s good rscn gen %d ID %3phC. %8phC\n",
3117                     sp->name, sp->gen1, &ct_req->req.port_id.port_id,
3118                     ct_rsp->rsp.gpn_id.port_name);
3119
3120         memset(&ea, 0, sizeof(ea));
3121         memcpy(ea.port_name, ct_rsp->rsp.gpn_id.port_name, WWN_SIZE);
3122         ea.sp = sp;
3123         ea.id = be_to_port_id(ct_req->req.port_id.port_id);
3124         ea.rc = res;
3125
3126         spin_lock_irqsave(&vha->hw->tgt.sess_lock, flags);
3127         list_del(&sp->elem);
3128         spin_unlock_irqrestore(&vha->hw->tgt.sess_lock, flags);
3129
3130         if (res) {
3131                 if (res == QLA_FUNCTION_TIMEOUT) {
3132                         qla24xx_post_gpnid_work(sp->vha, &ea.id);
3133                         sp->free(sp);
3134                         return;
3135                 }
3136         } else if (sp->gen1) {
3137                 /* There was another RSCN for this Nport ID */
3138                 qla24xx_post_gpnid_work(sp->vha, &ea.id);
3139                 sp->free(sp);
3140                 return;
3141         }
3142
3143         qla24xx_handle_gpnid_event(vha, &ea);
3144
3145         e = qla2x00_alloc_work(vha, QLA_EVT_UNMAP);
3146         if (!e) {
3147                 /* please ignore kernel warning. otherwise, we have mem leak. */
3148                 dma_free_coherent(&vha->hw->pdev->dev,
3149                                   sp->u.iocb_cmd.u.ctarg.req_allocated_size,
3150                                   sp->u.iocb_cmd.u.ctarg.req,
3151                                   sp->u.iocb_cmd.u.ctarg.req_dma);
3152                 sp->u.iocb_cmd.u.ctarg.req = NULL;
3153
3154                 dma_free_coherent(&vha->hw->pdev->dev,
3155                                   sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
3156                                   sp->u.iocb_cmd.u.ctarg.rsp,
3157                                   sp->u.iocb_cmd.u.ctarg.rsp_dma);
3158                 sp->u.iocb_cmd.u.ctarg.rsp = NULL;
3159
3160                 sp->free(sp);
3161                 return;
3162         }
3163
3164         e->u.iosb.sp = sp;
3165         qla2x00_post_work(vha, e);
3166 }
3167
3168 /* Get WWPN with Nport ID. */
3169 int qla24xx_async_gpnid(scsi_qla_host_t *vha, port_id_t *id)
3170 {
3171         int rval = QLA_FUNCTION_FAILED;
3172         struct ct_sns_req       *ct_req;
3173         srb_t *sp, *tsp;
3174         struct ct_sns_pkt *ct_sns;
3175         unsigned long flags;
3176
3177         if (!vha->flags.online)
3178                 goto done;
3179
3180         sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
3181         if (!sp)
3182                 goto done;
3183
3184         sp->type = SRB_CT_PTHRU_CMD;
3185         sp->name = "gpnid";
3186         sp->u.iocb_cmd.u.ctarg.id = *id;
3187         sp->gen1 = 0;
3188         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
3189
3190         spin_lock_irqsave(&vha->hw->tgt.sess_lock, flags);
3191         list_for_each_entry(tsp, &vha->gpnid_list, elem) {
3192                 if (tsp->u.iocb_cmd.u.ctarg.id.b24 == id->b24) {
3193                         tsp->gen1++;
3194                         spin_unlock_irqrestore(&vha->hw->tgt.sess_lock, flags);
3195                         sp->free(sp);
3196                         goto done;
3197                 }
3198         }
3199         list_add_tail(&sp->elem, &vha->gpnid_list);
3200         spin_unlock_irqrestore(&vha->hw->tgt.sess_lock, flags);
3201
3202         sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
3203                 sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.req_dma,
3204                 GFP_KERNEL);
3205         sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
3206         if (!sp->u.iocb_cmd.u.ctarg.req) {
3207                 ql_log(ql_log_warn, vha, 0xd041,
3208                     "Failed to allocate ct_sns request.\n");
3209                 goto done_free_sp;
3210         }
3211
3212         sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
3213                 sizeof(struct ct_sns_pkt), &sp->u.iocb_cmd.u.ctarg.rsp_dma,
3214                 GFP_KERNEL);
3215         sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = sizeof(struct ct_sns_pkt);
3216         if (!sp->u.iocb_cmd.u.ctarg.rsp) {
3217                 ql_log(ql_log_warn, vha, 0xd042,
3218                     "Failed to allocate ct_sns request.\n");
3219                 goto done_free_sp;
3220         }
3221
3222         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.rsp;
3223         memset(ct_sns, 0, sizeof(*ct_sns));
3224
3225         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
3226         /* CT_IU preamble  */
3227         ct_req = qla2x00_prep_ct_req(ct_sns, GPN_ID_CMD, GPN_ID_RSP_SIZE);
3228
3229         /* GPN_ID req */
3230         ct_req->req.port_id.port_id = port_id_to_be_id(*id);
3231
3232         sp->u.iocb_cmd.u.ctarg.req_size = GPN_ID_REQ_SIZE;
3233         sp->u.iocb_cmd.u.ctarg.rsp_size = GPN_ID_RSP_SIZE;
3234         sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
3235
3236         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
3237         sp->done = qla2x00_async_gpnid_sp_done;
3238
3239         ql_dbg(ql_dbg_disc, vha, 0x2067,
3240             "Async-%s hdl=%x ID %3phC.\n", sp->name,
3241             sp->handle, &ct_req->req.port_id.port_id);
3242
3243         rval = qla2x00_start_sp(sp);
3244         if (rval != QLA_SUCCESS)
3245                 goto done_free_sp;
3246
3247         return rval;
3248
3249 done_free_sp:
3250         spin_lock_irqsave(&vha->hw->vport_slock, flags);
3251         list_del(&sp->elem);
3252         spin_unlock_irqrestore(&vha->hw->vport_slock, flags);
3253
3254         if (sp->u.iocb_cmd.u.ctarg.req) {
3255                 dma_free_coherent(&vha->hw->pdev->dev,
3256                         sizeof(struct ct_sns_pkt),
3257                         sp->u.iocb_cmd.u.ctarg.req,
3258                         sp->u.iocb_cmd.u.ctarg.req_dma);
3259                 sp->u.iocb_cmd.u.ctarg.req = NULL;
3260         }
3261         if (sp->u.iocb_cmd.u.ctarg.rsp) {
3262                 dma_free_coherent(&vha->hw->pdev->dev,
3263                         sizeof(struct ct_sns_pkt),
3264                         sp->u.iocb_cmd.u.ctarg.rsp,
3265                         sp->u.iocb_cmd.u.ctarg.rsp_dma);
3266                 sp->u.iocb_cmd.u.ctarg.rsp = NULL;
3267         }
3268
3269         sp->free(sp);
3270 done:
3271         return rval;
3272 }
3273
3274 void qla24xx_handle_gffid_event(scsi_qla_host_t *vha, struct event_arg *ea)
3275 {
3276         fc_port_t *fcport = ea->fcport;
3277
3278         qla24xx_post_gnl_work(vha, fcport);
3279 }
3280
3281 void qla24xx_async_gffid_sp_done(srb_t *sp, int res)
3282 {
3283         struct scsi_qla_host *vha = sp->vha;
3284         fc_port_t *fcport = sp->fcport;
3285         struct ct_sns_rsp *ct_rsp;
3286         struct event_arg ea;
3287         uint8_t fc4_scsi_feat;
3288         uint8_t fc4_nvme_feat;
3289
3290         ql_dbg(ql_dbg_disc, vha, 0x2133,
3291                "Async done-%s res %x ID %x. %8phC\n",
3292                sp->name, res, fcport->d_id.b24, fcport->port_name);
3293
3294         fcport->flags &= ~FCF_ASYNC_SENT;
3295         ct_rsp = &fcport->ct_desc.ct_sns->p.rsp;
3296         fc4_scsi_feat = ct_rsp->rsp.gff_id.fc4_features[GFF_FCP_SCSI_OFFSET];
3297         fc4_nvme_feat = ct_rsp->rsp.gff_id.fc4_features[GFF_NVME_OFFSET];
3298
3299         /*
3300          * FC-GS-7, 5.2.3.12 FC-4 Features - format
3301          * The format of the FC-4 Features object, as defined by the FC-4,
3302          * Shall be an array of 4-bit values, one for each type code value
3303          */
3304         if (!res) {
3305                 if (fc4_scsi_feat & 0xf) {
3306                         /* w1 b00:03 */
3307                         fcport->fc4_type = FS_FC4TYPE_FCP;
3308                         fcport->fc4_features = fc4_scsi_feat & 0xf;
3309                 }
3310
3311                 if (fc4_nvme_feat & 0xf) {
3312                         /* w5 [00:03]/28h */
3313                         fcport->fc4_type |= FS_FC4TYPE_NVME;
3314                         fcport->fc4_features = fc4_nvme_feat & 0xf;
3315                 }
3316         }
3317
3318         memset(&ea, 0, sizeof(ea));
3319         ea.sp = sp;
3320         ea.fcport = sp->fcport;
3321         ea.rc = res;
3322
3323         qla24xx_handle_gffid_event(vha, &ea);
3324         sp->free(sp);
3325 }
3326
3327 /* Get FC4 Feature with Nport ID. */
3328 int qla24xx_async_gffid(scsi_qla_host_t *vha, fc_port_t *fcport)
3329 {
3330         int rval = QLA_FUNCTION_FAILED;
3331         struct ct_sns_req       *ct_req;
3332         srb_t *sp;
3333
3334         if (!vha->flags.online || (fcport->flags & FCF_ASYNC_SENT))
3335                 return rval;
3336
3337         sp = qla2x00_get_sp(vha, fcport, GFP_KERNEL);
3338         if (!sp)
3339                 return rval;
3340
3341         fcport->flags |= FCF_ASYNC_SENT;
3342         sp->type = SRB_CT_PTHRU_CMD;
3343         sp->name = "gffid";
3344         sp->gen1 = fcport->rscn_gen;
3345         sp->gen2 = fcport->login_gen;
3346
3347         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
3348         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
3349
3350         /* CT_IU preamble  */
3351         ct_req = qla2x00_prep_ct_req(fcport->ct_desc.ct_sns, GFF_ID_CMD,
3352             GFF_ID_RSP_SIZE);
3353
3354         ct_req->req.gff_id.port_id[0] = fcport->d_id.b.domain;
3355         ct_req->req.gff_id.port_id[1] = fcport->d_id.b.area;
3356         ct_req->req.gff_id.port_id[2] = fcport->d_id.b.al_pa;
3357
3358         sp->u.iocb_cmd.u.ctarg.req = fcport->ct_desc.ct_sns;
3359         sp->u.iocb_cmd.u.ctarg.req_dma = fcport->ct_desc.ct_sns_dma;
3360         sp->u.iocb_cmd.u.ctarg.rsp = fcport->ct_desc.ct_sns;
3361         sp->u.iocb_cmd.u.ctarg.rsp_dma = fcport->ct_desc.ct_sns_dma;
3362         sp->u.iocb_cmd.u.ctarg.req_size = GFF_ID_REQ_SIZE;
3363         sp->u.iocb_cmd.u.ctarg.rsp_size = GFF_ID_RSP_SIZE;
3364         sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
3365
3366         sp->done = qla24xx_async_gffid_sp_done;
3367
3368         ql_dbg(ql_dbg_disc, vha, 0x2132,
3369             "Async-%s hdl=%x  %8phC.\n", sp->name,
3370             sp->handle, fcport->port_name);
3371
3372         rval = qla2x00_start_sp(sp);
3373         if (rval != QLA_SUCCESS)
3374                 goto done_free_sp;
3375
3376         return rval;
3377 done_free_sp:
3378         sp->free(sp);
3379         fcport->flags &= ~FCF_ASYNC_SENT;
3380         return rval;
3381 }
3382
3383 /* GPN_FT + GNN_FT*/
3384 static int qla2x00_is_a_vp(scsi_qla_host_t *vha, u64 wwn)
3385 {
3386         struct qla_hw_data *ha = vha->hw;
3387         scsi_qla_host_t *vp;
3388         unsigned long flags;
3389         u64 twwn;
3390         int rc = 0;
3391
3392         if (!ha->num_vhosts)
3393                 return 0;
3394
3395         spin_lock_irqsave(&ha->vport_slock, flags);
3396         list_for_each_entry(vp, &ha->vp_list, list) {
3397                 twwn = wwn_to_u64(vp->port_name);
3398                 if (wwn == twwn) {
3399                         rc = 1;
3400                         break;
3401                 }
3402         }
3403         spin_unlock_irqrestore(&ha->vport_slock, flags);
3404
3405         return rc;
3406 }
3407
3408 void qla24xx_async_gnnft_done(scsi_qla_host_t *vha, srb_t *sp)
3409 {
3410         fc_port_t *fcport;
3411         u32 i, rc;
3412         bool found;
3413         struct fab_scan_rp *rp, *trp;
3414         unsigned long flags;
3415         u8 recheck = 0;
3416         u16 dup = 0, dup_cnt = 0;
3417
3418         ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3419             "%s enter\n", __func__);
3420
3421         if (sp->gen1 != vha->hw->base_qpair->chip_reset) {
3422                 ql_dbg(ql_dbg_disc, vha, 0xffff,
3423                     "%s scan stop due to chip reset %x/%x\n",
3424                     sp->name, sp->gen1, vha->hw->base_qpair->chip_reset);
3425                 goto out;
3426         }
3427
3428         rc = sp->rc;
3429         if (rc) {
3430                 vha->scan.scan_retry++;
3431                 if (vha->scan.scan_retry < MAX_SCAN_RETRIES) {
3432                         set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3433                         set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3434                         goto out;
3435                 } else {
3436                         ql_dbg(ql_dbg_disc, vha, 0xffff,
3437                             "%s: Fabric scan failed for %d retries.\n",
3438                             __func__, vha->scan.scan_retry);
3439                         /*
3440                          * Unable to scan any rports. logout loop below
3441                          * will unregister all sessions.
3442                          */
3443                         list_for_each_entry(fcport, &vha->vp_fcports, list) {
3444                                 if ((fcport->flags & FCF_FABRIC_DEVICE) != 0) {
3445                                         fcport->scan_state = QLA_FCPORT_SCAN;
3446                                 }
3447                         }
3448                         goto login_logout;
3449                 }
3450         }
3451         vha->scan.scan_retry = 0;
3452
3453         list_for_each_entry(fcport, &vha->vp_fcports, list)
3454                 fcport->scan_state = QLA_FCPORT_SCAN;
3455
3456         for (i = 0; i < vha->hw->max_fibre_devices; i++) {
3457                 u64 wwn;
3458                 int k;
3459
3460                 rp = &vha->scan.l[i];
3461                 found = false;
3462
3463                 wwn = wwn_to_u64(rp->port_name);
3464                 if (wwn == 0)
3465                         continue;
3466
3467                 /* Remove duplicate NPORT ID entries from switch data base */
3468                 for (k = i + 1; k < vha->hw->max_fibre_devices; k++) {
3469                         trp = &vha->scan.l[k];
3470                         if (rp->id.b24 == trp->id.b24) {
3471                                 dup = 1;
3472                                 dup_cnt++;
3473                                 ql_dbg(ql_dbg_disc + ql_dbg_verbose,
3474                                     vha, 0xffff,
3475                                     "Detected duplicate NPORT ID from switch data base: ID %06x WWN %8phN WWN %8phN\n",
3476                                     rp->id.b24, rp->port_name, trp->port_name);
3477                                 memset(trp, 0, sizeof(*trp));
3478                         }
3479                 }
3480
3481                 if (!memcmp(rp->port_name, vha->port_name, WWN_SIZE))
3482                         continue;
3483
3484                 /* Bypass reserved domain fields. */
3485                 if ((rp->id.b.domain & 0xf0) == 0xf0)
3486                         continue;
3487
3488                 /* Bypass virtual ports of the same host. */
3489                 if (qla2x00_is_a_vp(vha, wwn))
3490                         continue;
3491
3492                 list_for_each_entry(fcport, &vha->vp_fcports, list) {
3493                         if (memcmp(rp->port_name, fcport->port_name, WWN_SIZE))
3494                                 continue;
3495                         fcport->scan_state = QLA_FCPORT_FOUND;
3496                         fcport->last_rscn_gen = fcport->rscn_gen;
3497                         found = true;
3498                         /*
3499                          * If device was not a fabric device before.
3500                          */
3501                         if ((fcport->flags & FCF_FABRIC_DEVICE) == 0) {
3502                                 qla2x00_clear_loop_id(fcport);
3503                                 fcport->flags |= FCF_FABRIC_DEVICE;
3504                         } else if (fcport->d_id.b24 != rp->id.b24 ||
3505                                    (fcport->scan_needed &&
3506                                     fcport->port_type != FCT_INITIATOR &&
3507                                     fcport->port_type != FCT_NVME_INITIATOR)) {
3508                                 qlt_schedule_sess_for_deletion(fcport);
3509                         }
3510                         fcport->d_id.b24 = rp->id.b24;
3511                         fcport->scan_needed = 0;
3512                         break;
3513                 }
3514
3515                 if (!found) {
3516                         ql_dbg(ql_dbg_disc, vha, 0xffff,
3517                             "%s %d %8phC post new sess\n",
3518                             __func__, __LINE__, rp->port_name);
3519                         qla24xx_post_newsess_work(vha, &rp->id, rp->port_name,
3520                             rp->node_name, NULL, rp->fc4type);
3521                 }
3522         }
3523
3524         if (dup) {
3525                 ql_log(ql_log_warn, vha, 0xffff,
3526                     "Detected %d duplicate NPORT ID(s) from switch data base\n",
3527                     dup_cnt);
3528         }
3529
3530 login_logout:
3531         /*
3532          * Logout all previous fabric dev marked lost, except FCP2 devices.
3533          */
3534         list_for_each_entry(fcport, &vha->vp_fcports, list) {
3535                 if ((fcport->flags & FCF_FABRIC_DEVICE) == 0) {
3536                         fcport->scan_needed = 0;
3537                         continue;
3538                 }
3539
3540                 if (fcport->scan_state != QLA_FCPORT_FOUND) {
3541                         bool do_delete = false;
3542
3543                         if (fcport->scan_needed &&
3544                             fcport->disc_state == DSC_LOGIN_PEND) {
3545                                 /* Cable got disconnected after we sent
3546                                  * a login. Do delete to prevent timeout.
3547                                  */
3548                                 fcport->logout_on_delete = 1;
3549                                 do_delete = true;
3550                         }
3551
3552                         fcport->scan_needed = 0;
3553                         if (((qla_dual_mode_enabled(vha) ||
3554                               qla_ini_mode_enabled(vha)) &&
3555                             atomic_read(&fcport->state) == FCS_ONLINE) ||
3556                                 do_delete) {
3557                                 if (fcport->loop_id != FC_NO_LOOP_ID) {
3558                                         if (fcport->flags & FCF_FCP2_DEVICE)
3559                                                 fcport->logout_on_delete = 0;
3560
3561                                         ql_log(ql_log_warn, vha, 0x20f0,
3562                                                "%s %d %8phC post del sess\n",
3563                                                __func__, __LINE__,
3564                                                fcport->port_name);
3565
3566                                         fcport->tgt_link_down_time = 0;
3567                                         qlt_schedule_sess_for_deletion(fcport);
3568                                         continue;
3569                                 }
3570                         }
3571                 } else {
3572                         if (fcport->scan_needed ||
3573                             fcport->disc_state != DSC_LOGIN_COMPLETE) {
3574                                 if (fcport->login_retry == 0) {
3575                                         fcport->login_retry =
3576                                                 vha->hw->login_retry_count;
3577                                         ql_dbg(ql_dbg_disc, vha, 0x20a3,
3578                                             "Port login retry %8phN, lid 0x%04x retry cnt=%d.\n",
3579                                             fcport->port_name, fcport->loop_id,
3580                                             fcport->login_retry);
3581                                 }
3582                                 fcport->scan_needed = 0;
3583                                 qla24xx_fcport_handle_login(vha, fcport);
3584                         }
3585                 }
3586         }
3587
3588         recheck = 1;
3589 out:
3590         qla24xx_sp_unmap(vha, sp);
3591         spin_lock_irqsave(&vha->work_lock, flags);
3592         vha->scan.scan_flags &= ~SF_SCANNING;
3593         spin_unlock_irqrestore(&vha->work_lock, flags);
3594
3595         if (recheck) {
3596                 list_for_each_entry(fcport, &vha->vp_fcports, list) {
3597                         if (fcport->scan_needed) {
3598                                 set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3599                                 set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3600                                 break;
3601                         }
3602                 }
3603         }
3604 }
3605
3606 static int qla2x00_post_gnnft_gpnft_done_work(struct scsi_qla_host *vha,
3607     srb_t *sp, int cmd)
3608 {
3609         struct qla_work_evt *e;
3610
3611         if (cmd != QLA_EVT_GPNFT_DONE && cmd != QLA_EVT_GNNFT_DONE)
3612                 return QLA_PARAMETER_ERROR;
3613
3614         e = qla2x00_alloc_work(vha, cmd);
3615         if (!e)
3616                 return QLA_FUNCTION_FAILED;
3617
3618         e->u.iosb.sp = sp;
3619
3620         return qla2x00_post_work(vha, e);
3621 }
3622
3623 static int qla2x00_post_nvme_gpnft_work(struct scsi_qla_host *vha,
3624     srb_t *sp, int cmd)
3625 {
3626         struct qla_work_evt *e;
3627
3628         if (cmd != QLA_EVT_GPNFT)
3629                 return QLA_PARAMETER_ERROR;
3630
3631         e = qla2x00_alloc_work(vha, cmd);
3632         if (!e)
3633                 return QLA_FUNCTION_FAILED;
3634
3635         e->u.gpnft.fc4_type = FC4_TYPE_NVME;
3636         e->u.gpnft.sp = sp;
3637
3638         return qla2x00_post_work(vha, e);
3639 }
3640
3641 static void qla2x00_find_free_fcp_nvme_slot(struct scsi_qla_host *vha,
3642         struct srb *sp)
3643 {
3644         struct qla_hw_data *ha = vha->hw;
3645         int num_fibre_dev = ha->max_fibre_devices;
3646         struct ct_sns_req *ct_req =
3647                 (struct ct_sns_req *)sp->u.iocb_cmd.u.ctarg.req;
3648         struct ct_sns_gpnft_rsp *ct_rsp =
3649                 (struct ct_sns_gpnft_rsp *)sp->u.iocb_cmd.u.ctarg.rsp;
3650         struct ct_sns_gpn_ft_data *d;
3651         struct fab_scan_rp *rp;
3652         u16 cmd = be16_to_cpu(ct_req->command);
3653         u8 fc4_type = sp->gen2;
3654         int i, j, k;
3655         port_id_t id;
3656         u8 found;
3657         u64 wwn;
3658
3659         j = 0;
3660         for (i = 0; i < num_fibre_dev; i++) {
3661                 d  = &ct_rsp->entries[i];
3662
3663                 id.b.rsvd_1 = 0;
3664                 id.b.domain = d->port_id[0];
3665                 id.b.area   = d->port_id[1];
3666                 id.b.al_pa  = d->port_id[2];
3667                 wwn = wwn_to_u64(d->port_name);
3668
3669                 if (id.b24 == 0 || wwn == 0)
3670                         continue;
3671
3672                 if (fc4_type == FC4_TYPE_FCP_SCSI) {
3673                         if (cmd == GPN_FT_CMD) {
3674                                 rp = &vha->scan.l[j];
3675                                 rp->id = id;
3676                                 memcpy(rp->port_name, d->port_name, 8);
3677                                 j++;
3678                                 rp->fc4type = FS_FC4TYPE_FCP;
3679                         } else {
3680                                 for (k = 0; k < num_fibre_dev; k++) {
3681                                         rp = &vha->scan.l[k];
3682                                         if (id.b24 == rp->id.b24) {
3683                                                 memcpy(rp->node_name,
3684                                                     d->port_name, 8);
3685                                                 break;
3686                                         }
3687                                 }
3688                         }
3689                 } else {
3690                         /* Search if the fibre device supports FC4_TYPE_NVME */
3691                         if (cmd == GPN_FT_CMD) {
3692                                 found = 0;
3693
3694                                 for (k = 0; k < num_fibre_dev; k++) {
3695                                         rp = &vha->scan.l[k];
3696                                         if (!memcmp(rp->port_name,
3697                                             d->port_name, 8)) {
3698                                                 /*
3699                                                  * Supports FC-NVMe & FCP
3700                                                  */
3701                                                 rp->fc4type |= FS_FC4TYPE_NVME;
3702                                                 found = 1;
3703                                                 break;
3704                                         }
3705                                 }
3706
3707                                 /* We found new FC-NVMe only port */
3708                                 if (!found) {
3709                                         for (k = 0; k < num_fibre_dev; k++) {
3710                                                 rp = &vha->scan.l[k];
3711                                                 if (wwn_to_u64(rp->port_name)) {
3712                                                         continue;
3713                                                 } else {
3714                                                         rp->id = id;
3715                                                         memcpy(rp->port_name,
3716                                                             d->port_name, 8);
3717                                                         rp->fc4type =
3718                                                             FS_FC4TYPE_NVME;
3719                                                         break;
3720                                                 }
3721                                         }
3722                                 }
3723                         } else {
3724                                 for (k = 0; k < num_fibre_dev; k++) {
3725                                         rp = &vha->scan.l[k];
3726                                         if (id.b24 == rp->id.b24) {
3727                                                 memcpy(rp->node_name,
3728                                                     d->port_name, 8);
3729                                                 break;
3730                                         }
3731                                 }
3732                         }
3733                 }
3734         }
3735 }
3736
3737 static void qla2x00_async_gpnft_gnnft_sp_done(srb_t *sp, int res)
3738 {
3739         struct scsi_qla_host *vha = sp->vha;
3740         struct ct_sns_req *ct_req =
3741                 (struct ct_sns_req *)sp->u.iocb_cmd.u.ctarg.req;
3742         u16 cmd = be16_to_cpu(ct_req->command);
3743         u8 fc4_type = sp->gen2;
3744         unsigned long flags;
3745         int rc;
3746
3747         /* gen2 field is holding the fc4type */
3748         ql_dbg(ql_dbg_disc, vha, 0xffff,
3749             "Async done-%s res %x FC4Type %x\n",
3750             sp->name, res, sp->gen2);
3751
3752         del_timer(&sp->u.iocb_cmd.timer);
3753         sp->rc = res;
3754         if (res) {
3755                 unsigned long flags;
3756                 const char *name = sp->name;
3757
3758                 if (res == QLA_OS_TIMER_EXPIRED) {
3759                         /* switch is ignoring all commands.
3760                          * This might be a zone disable behavior.
3761                          * This means we hit 64s timeout.
3762                          * 22s GPNFT + 44s Abort = 64s
3763                          */
3764                         ql_dbg(ql_dbg_disc, vha, 0xffff,
3765                                "%s: Switch Zone check please .\n",
3766                                name);
3767                         qla2x00_mark_all_devices_lost(vha);
3768                 }
3769
3770                 /*
3771                  * We are in an Interrupt context, queue up this
3772                  * sp for GNNFT_DONE work. This will allow all
3773                  * the resource to get freed up.
3774                  */
3775                 rc = qla2x00_post_gnnft_gpnft_done_work(vha, sp,
3776                     QLA_EVT_GNNFT_DONE);
3777                 if (rc) {
3778                         /* Cleanup here to prevent memory leak */
3779                         qla24xx_sp_unmap(vha, sp);
3780
3781                         spin_lock_irqsave(&vha->work_lock, flags);
3782                         vha->scan.scan_flags &= ~SF_SCANNING;
3783                         vha->scan.scan_retry++;
3784                         spin_unlock_irqrestore(&vha->work_lock, flags);
3785
3786                         if (vha->scan.scan_retry < MAX_SCAN_RETRIES) {
3787                                 set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3788                                 set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3789                                 qla2xxx_wake_dpc(vha);
3790                         } else {
3791                                 ql_dbg(ql_dbg_disc, vha, 0xffff,
3792                                     "Async done-%s rescan failed on all retries.\n",
3793                                     name);
3794                         }
3795                 }
3796                 return;
3797         }
3798
3799         qla2x00_find_free_fcp_nvme_slot(vha, sp);
3800
3801         if ((fc4_type == FC4_TYPE_FCP_SCSI) && vha->flags.nvme_enabled &&
3802             cmd == GNN_FT_CMD) {
3803                 spin_lock_irqsave(&vha->work_lock, flags);
3804                 vha->scan.scan_flags &= ~SF_SCANNING;
3805                 spin_unlock_irqrestore(&vha->work_lock, flags);
3806
3807                 sp->rc = res;
3808                 rc = qla2x00_post_nvme_gpnft_work(vha, sp, QLA_EVT_GPNFT);
3809                 if (rc) {
3810                         qla24xx_sp_unmap(vha, sp);
3811                         set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3812                         set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3813                 }
3814                 return;
3815         }
3816
3817         if (cmd == GPN_FT_CMD) {
3818                 rc = qla2x00_post_gnnft_gpnft_done_work(vha, sp,
3819                     QLA_EVT_GPNFT_DONE);
3820         } else {
3821                 rc = qla2x00_post_gnnft_gpnft_done_work(vha, sp,
3822                     QLA_EVT_GNNFT_DONE);
3823         }
3824
3825         if (rc) {
3826                 qla24xx_sp_unmap(vha, sp);
3827                 set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3828                 set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3829                 return;
3830         }
3831 }
3832
3833 /*
3834  * Get WWNN list for fc4_type
3835  *
3836  * It is assumed the same SRB is re-used from GPNFT to avoid
3837  * mem free & re-alloc
3838  */
3839 static int qla24xx_async_gnnft(scsi_qla_host_t *vha, struct srb *sp,
3840     u8 fc4_type)
3841 {
3842         int rval = QLA_FUNCTION_FAILED;
3843         struct ct_sns_req *ct_req;
3844         struct ct_sns_pkt *ct_sns;
3845         unsigned long flags;
3846
3847         if (!vha->flags.online) {
3848                 spin_lock_irqsave(&vha->work_lock, flags);
3849                 vha->scan.scan_flags &= ~SF_SCANNING;
3850                 spin_unlock_irqrestore(&vha->work_lock, flags);
3851                 goto done_free_sp;
3852         }
3853
3854         if (!sp->u.iocb_cmd.u.ctarg.req || !sp->u.iocb_cmd.u.ctarg.rsp) {
3855                 ql_log(ql_log_warn, vha, 0xffff,
3856                     "%s: req %p rsp %p are not setup\n",
3857                     __func__, sp->u.iocb_cmd.u.ctarg.req,
3858                     sp->u.iocb_cmd.u.ctarg.rsp);
3859                 spin_lock_irqsave(&vha->work_lock, flags);
3860                 vha->scan.scan_flags &= ~SF_SCANNING;
3861                 spin_unlock_irqrestore(&vha->work_lock, flags);
3862                 WARN_ON(1);
3863                 set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
3864                 set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
3865                 goto done_free_sp;
3866         }
3867
3868         ql_dbg(ql_dbg_disc, vha, 0xfffff,
3869             "%s: FC4Type %x, CT-PASSTHRU %s command ctarg rsp size %d, ctarg req size %d\n",
3870             __func__, fc4_type, sp->name, sp->u.iocb_cmd.u.ctarg.rsp_size,
3871              sp->u.iocb_cmd.u.ctarg.req_size);
3872
3873         sp->type = SRB_CT_PTHRU_CMD;
3874         sp->name = "gnnft";
3875         sp->gen1 = vha->hw->base_qpair->chip_reset;
3876         sp->gen2 = fc4_type;
3877
3878         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
3879         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
3880
3881         memset(sp->u.iocb_cmd.u.ctarg.rsp, 0, sp->u.iocb_cmd.u.ctarg.rsp_size);
3882         memset(sp->u.iocb_cmd.u.ctarg.req, 0, sp->u.iocb_cmd.u.ctarg.req_size);
3883
3884         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
3885         /* CT_IU preamble  */
3886         ct_req = qla2x00_prep_ct_req(ct_sns, GNN_FT_CMD,
3887             sp->u.iocb_cmd.u.ctarg.rsp_size);
3888
3889         /* GPN_FT req */
3890         ct_req->req.gpn_ft.port_type = fc4_type;
3891
3892         sp->u.iocb_cmd.u.ctarg.req_size = GNN_FT_REQ_SIZE;
3893         sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
3894
3895         sp->done = qla2x00_async_gpnft_gnnft_sp_done;
3896
3897         ql_dbg(ql_dbg_disc, vha, 0xffff,
3898             "Async-%s hdl=%x FC4Type %x.\n", sp->name,
3899             sp->handle, ct_req->req.gpn_ft.port_type);
3900
3901         rval = qla2x00_start_sp(sp);
3902         if (rval != QLA_SUCCESS) {
3903                 goto done_free_sp;
3904         }
3905
3906         return rval;
3907
3908 done_free_sp:
3909         if (sp->u.iocb_cmd.u.ctarg.req) {
3910                 dma_free_coherent(&vha->hw->pdev->dev,
3911                     sp->u.iocb_cmd.u.ctarg.req_allocated_size,
3912                     sp->u.iocb_cmd.u.ctarg.req,
3913                     sp->u.iocb_cmd.u.ctarg.req_dma);
3914                 sp->u.iocb_cmd.u.ctarg.req = NULL;
3915         }
3916         if (sp->u.iocb_cmd.u.ctarg.rsp) {
3917                 dma_free_coherent(&vha->hw->pdev->dev,
3918                     sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
3919                     sp->u.iocb_cmd.u.ctarg.rsp,
3920                     sp->u.iocb_cmd.u.ctarg.rsp_dma);
3921                 sp->u.iocb_cmd.u.ctarg.rsp = NULL;
3922         }
3923
3924         sp->free(sp);
3925
3926         spin_lock_irqsave(&vha->work_lock, flags);
3927         vha->scan.scan_flags &= ~SF_SCANNING;
3928         if (vha->scan.scan_flags == 0) {
3929                 ql_dbg(ql_dbg_disc, vha, 0xffff,
3930                     "%s: schedule\n", __func__);
3931                 vha->scan.scan_flags |= SF_QUEUED;
3932                 schedule_delayed_work(&vha->scan.scan_work, 5);
3933         }
3934         spin_unlock_irqrestore(&vha->work_lock, flags);
3935
3936
3937         return rval;
3938 } /* GNNFT */
3939
3940 void qla24xx_async_gpnft_done(scsi_qla_host_t *vha, srb_t *sp)
3941 {
3942         ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3943             "%s enter\n", __func__);
3944         qla24xx_async_gnnft(vha, sp, sp->gen2);
3945 }
3946
3947 /* Get WWPN list for certain fc4_type */
3948 int qla24xx_async_gpnft(scsi_qla_host_t *vha, u8 fc4_type, srb_t *sp)
3949 {
3950         int rval = QLA_FUNCTION_FAILED;
3951         struct ct_sns_req       *ct_req;
3952         struct ct_sns_pkt *ct_sns;
3953         u32 rspsz;
3954         unsigned long flags;
3955
3956         ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3957             "%s enter\n", __func__);
3958
3959         if (!vha->flags.online)
3960                 return rval;
3961
3962         spin_lock_irqsave(&vha->work_lock, flags);
3963         if (vha->scan.scan_flags & SF_SCANNING) {
3964                 spin_unlock_irqrestore(&vha->work_lock, flags);
3965                 ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3966                     "%s: scan active\n", __func__);
3967                 return rval;
3968         }
3969         vha->scan.scan_flags |= SF_SCANNING;
3970         spin_unlock_irqrestore(&vha->work_lock, flags);
3971
3972         if (fc4_type == FC4_TYPE_FCP_SCSI) {
3973                 ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
3974                     "%s: Performing FCP Scan\n", __func__);
3975
3976                 if (sp)
3977                         sp->free(sp); /* should not happen */
3978
3979                 sp = qla2x00_get_sp(vha, NULL, GFP_KERNEL);
3980                 if (!sp) {
3981                         spin_lock_irqsave(&vha->work_lock, flags);
3982                         vha->scan.scan_flags &= ~SF_SCANNING;
3983                         spin_unlock_irqrestore(&vha->work_lock, flags);
3984                         return rval;
3985                 }
3986
3987                 sp->u.iocb_cmd.u.ctarg.req = dma_alloc_coherent(&vha->hw->pdev->dev,
3988                                                                 sizeof(struct ct_sns_pkt),
3989                                                                 &sp->u.iocb_cmd.u.ctarg.req_dma,
3990                                                                 GFP_KERNEL);
3991                 sp->u.iocb_cmd.u.ctarg.req_allocated_size = sizeof(struct ct_sns_pkt);
3992                 if (!sp->u.iocb_cmd.u.ctarg.req) {
3993                         ql_log(ql_log_warn, vha, 0xffff,
3994                             "Failed to allocate ct_sns request.\n");
3995                         spin_lock_irqsave(&vha->work_lock, flags);
3996                         vha->scan.scan_flags &= ~SF_SCANNING;
3997                         spin_unlock_irqrestore(&vha->work_lock, flags);
3998                         qla2x00_rel_sp(sp);
3999                         return rval;
4000                 }
4001                 sp->u.iocb_cmd.u.ctarg.req_size = GPN_FT_REQ_SIZE;
4002
4003                 rspsz = sizeof(struct ct_sns_gpnft_rsp) +
4004                         ((vha->hw->max_fibre_devices - 1) *
4005                             sizeof(struct ct_sns_gpn_ft_data));
4006
4007                 sp->u.iocb_cmd.u.ctarg.rsp = dma_alloc_coherent(&vha->hw->pdev->dev,
4008                                                                 rspsz,
4009                                                                 &sp->u.iocb_cmd.u.ctarg.rsp_dma,
4010                                                                 GFP_KERNEL);
4011                 sp->u.iocb_cmd.u.ctarg.rsp_allocated_size = rspsz;
4012                 if (!sp->u.iocb_cmd.u.ctarg.rsp) {
4013                         ql_log(ql_log_warn, vha, 0xffff,
4014                             "Failed to allocate ct_sns request.\n");
4015                         spin_lock_irqsave(&vha->work_lock, flags);
4016                         vha->scan.scan_flags &= ~SF_SCANNING;
4017                         spin_unlock_irqrestore(&vha->work_lock, flags);
4018                         dma_free_coherent(&vha->hw->pdev->dev,
4019                             sp->u.iocb_cmd.u.ctarg.req_allocated_size,
4020                             sp->u.iocb_cmd.u.ctarg.req,
4021                             sp->u.iocb_cmd.u.ctarg.req_dma);
4022                         sp->u.iocb_cmd.u.ctarg.req = NULL;
4023                         qla2x00_rel_sp(sp);
4024                         return rval;
4025                 }
4026                 sp->u.iocb_cmd.u.ctarg.rsp_size = rspsz;
4027
4028                 ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
4029                     "%s scan list size %d\n", __func__, vha->scan.size);
4030
4031                 memset(vha->scan.l, 0, vha->scan.size);
4032         } else if (!sp) {
4033                 ql_dbg(ql_dbg_disc, vha, 0xffff,
4034                     "NVME scan did not provide SP\n");
4035                 return rval;
4036         }
4037
4038         sp->type = SRB_CT_PTHRU_CMD;
4039         sp->name = "gpnft";
4040         sp->gen1 = vha->hw->base_qpair->chip_reset;
4041         sp->gen2 = fc4_type;
4042
4043         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
4044         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
4045
4046         rspsz = sp->u.iocb_cmd.u.ctarg.rsp_size;
4047         memset(sp->u.iocb_cmd.u.ctarg.rsp, 0, sp->u.iocb_cmd.u.ctarg.rsp_size);
4048         memset(sp->u.iocb_cmd.u.ctarg.req, 0, sp->u.iocb_cmd.u.ctarg.req_size);
4049
4050         ct_sns = (struct ct_sns_pkt *)sp->u.iocb_cmd.u.ctarg.req;
4051         /* CT_IU preamble  */
4052         ct_req = qla2x00_prep_ct_req(ct_sns, GPN_FT_CMD, rspsz);
4053
4054         /* GPN_FT req */
4055         ct_req->req.gpn_ft.port_type = fc4_type;
4056
4057         sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
4058
4059         sp->done = qla2x00_async_gpnft_gnnft_sp_done;
4060
4061         ql_dbg(ql_dbg_disc, vha, 0xffff,
4062             "Async-%s hdl=%x FC4Type %x.\n", sp->name,
4063             sp->handle, ct_req->req.gpn_ft.port_type);
4064
4065         rval = qla2x00_start_sp(sp);
4066         if (rval != QLA_SUCCESS) {
4067                 goto done_free_sp;
4068         }
4069
4070         return rval;
4071
4072 done_free_sp:
4073         if (sp->u.iocb_cmd.u.ctarg.req) {
4074                 dma_free_coherent(&vha->hw->pdev->dev,
4075                     sp->u.iocb_cmd.u.ctarg.req_allocated_size,
4076                     sp->u.iocb_cmd.u.ctarg.req,
4077                     sp->u.iocb_cmd.u.ctarg.req_dma);
4078                 sp->u.iocb_cmd.u.ctarg.req = NULL;
4079         }
4080         if (sp->u.iocb_cmd.u.ctarg.rsp) {
4081                 dma_free_coherent(&vha->hw->pdev->dev,
4082                     sp->u.iocb_cmd.u.ctarg.rsp_allocated_size,
4083                     sp->u.iocb_cmd.u.ctarg.rsp,
4084                     sp->u.iocb_cmd.u.ctarg.rsp_dma);
4085                 sp->u.iocb_cmd.u.ctarg.rsp = NULL;
4086         }
4087
4088         sp->free(sp);
4089
4090         spin_lock_irqsave(&vha->work_lock, flags);
4091         vha->scan.scan_flags &= ~SF_SCANNING;
4092         if (vha->scan.scan_flags == 0) {
4093                 ql_dbg(ql_dbg_disc + ql_dbg_verbose, vha, 0xffff,
4094                     "%s: Scan scheduled.\n", __func__);
4095                 vha->scan.scan_flags |= SF_QUEUED;
4096                 schedule_delayed_work(&vha->scan.scan_work, 5);
4097         }
4098         spin_unlock_irqrestore(&vha->work_lock, flags);
4099
4100
4101         return rval;
4102 }
4103
4104 void qla_scan_work_fn(struct work_struct *work)
4105 {
4106         struct fab_scan *s = container_of(to_delayed_work(work),
4107             struct fab_scan, scan_work);
4108         struct scsi_qla_host *vha = container_of(s, struct scsi_qla_host,
4109             scan);
4110         unsigned long flags;
4111
4112         ql_dbg(ql_dbg_disc, vha, 0xffff,
4113             "%s: schedule loop resync\n", __func__);
4114         set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
4115         set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
4116         qla2xxx_wake_dpc(vha);
4117         spin_lock_irqsave(&vha->work_lock, flags);
4118         vha->scan.scan_flags &= ~SF_QUEUED;
4119         spin_unlock_irqrestore(&vha->work_lock, flags);
4120 }
4121
4122 /* GNN_ID */
4123 void qla24xx_handle_gnnid_event(scsi_qla_host_t *vha, struct event_arg *ea)
4124 {
4125         qla24xx_post_gnl_work(vha, ea->fcport);
4126 }
4127
4128 static void qla2x00_async_gnnid_sp_done(srb_t *sp, int res)
4129 {
4130         struct scsi_qla_host *vha = sp->vha;
4131         fc_port_t *fcport = sp->fcport;
4132         u8 *node_name = fcport->ct_desc.ct_sns->p.rsp.rsp.gnn_id.node_name;
4133         struct event_arg ea;
4134         u64 wwnn;
4135
4136         fcport->flags &= ~FCF_ASYNC_SENT;
4137         wwnn = wwn_to_u64(node_name);
4138         if (wwnn)
4139                 memcpy(fcport->node_name, node_name, WWN_SIZE);
4140
4141         memset(&ea, 0, sizeof(ea));
4142         ea.fcport = fcport;
4143         ea.sp = sp;
4144         ea.rc = res;
4145
4146         ql_dbg(ql_dbg_disc, vha, 0x204f,
4147             "Async done-%s res %x, WWPN %8phC %8phC\n",
4148             sp->name, res, fcport->port_name, fcport->node_name);
4149
4150         qla24xx_handle_gnnid_event(vha, &ea);
4151
4152         sp->free(sp);
4153 }
4154
4155 int qla24xx_async_gnnid(scsi_qla_host_t *vha, fc_port_t *fcport)
4156 {
4157         int rval = QLA_FUNCTION_FAILED;
4158         struct ct_sns_req       *ct_req;
4159         srb_t *sp;
4160
4161         if (!vha->flags.online || (fcport->flags & FCF_ASYNC_SENT))
4162                 return rval;
4163
4164         qla2x00_set_fcport_disc_state(fcport, DSC_GNN_ID);
4165         sp = qla2x00_get_sp(vha, fcport, GFP_ATOMIC);
4166         if (!sp)
4167                 goto done;
4168
4169         fcport->flags |= FCF_ASYNC_SENT;
4170         sp->type = SRB_CT_PTHRU_CMD;
4171         sp->name = "gnnid";
4172         sp->gen1 = fcport->rscn_gen;
4173         sp->gen2 = fcport->login_gen;
4174
4175         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
4176         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
4177
4178         /* CT_IU preamble  */
4179         ct_req = qla2x00_prep_ct_req(fcport->ct_desc.ct_sns, GNN_ID_CMD,
4180             GNN_ID_RSP_SIZE);
4181
4182         /* GNN_ID req */
4183         ct_req->req.port_id.port_id = port_id_to_be_id(fcport->d_id);
4184
4185
4186         /* req & rsp use the same buffer */
4187         sp->u.iocb_cmd.u.ctarg.req = fcport->ct_desc.ct_sns;
4188         sp->u.iocb_cmd.u.ctarg.req_dma = fcport->ct_desc.ct_sns_dma;
4189         sp->u.iocb_cmd.u.ctarg.rsp = fcport->ct_desc.ct_sns;
4190         sp->u.iocb_cmd.u.ctarg.rsp_dma = fcport->ct_desc.ct_sns_dma;
4191         sp->u.iocb_cmd.u.ctarg.req_size = GNN_ID_REQ_SIZE;
4192         sp->u.iocb_cmd.u.ctarg.rsp_size = GNN_ID_RSP_SIZE;
4193         sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
4194
4195         sp->done = qla2x00_async_gnnid_sp_done;
4196
4197         ql_dbg(ql_dbg_disc, vha, 0xffff,
4198             "Async-%s - %8phC hdl=%x loopid=%x portid %06x.\n",
4199             sp->name, fcport->port_name,
4200             sp->handle, fcport->loop_id, fcport->d_id.b24);
4201
4202         rval = qla2x00_start_sp(sp);
4203         if (rval != QLA_SUCCESS)
4204                 goto done_free_sp;
4205         return rval;
4206
4207 done_free_sp:
4208         sp->free(sp);
4209         fcport->flags &= ~FCF_ASYNC_SENT;
4210 done:
4211         return rval;
4212 }
4213
4214 int qla24xx_post_gnnid_work(struct scsi_qla_host *vha, fc_port_t *fcport)
4215 {
4216         struct qla_work_evt *e;
4217         int ls;
4218
4219         ls = atomic_read(&vha->loop_state);
4220         if (((ls != LOOP_READY) && (ls != LOOP_UP)) ||
4221                 test_bit(UNLOADING, &vha->dpc_flags))
4222                 return 0;
4223
4224         e = qla2x00_alloc_work(vha, QLA_EVT_GNNID);
4225         if (!e)
4226                 return QLA_FUNCTION_FAILED;
4227
4228         e->u.fcport.fcport = fcport;
4229         return qla2x00_post_work(vha, e);
4230 }
4231
4232 /* GPFN_ID */
4233 void qla24xx_handle_gfpnid_event(scsi_qla_host_t *vha, struct event_arg *ea)
4234 {
4235         fc_port_t *fcport = ea->fcport;
4236
4237         ql_dbg(ql_dbg_disc, vha, 0xffff,
4238             "%s %8phC DS %d LS %d rc %d login %d|%d rscn %d|%d fcpcnt %d\n",
4239             __func__, fcport->port_name, fcport->disc_state,
4240             fcport->fw_login_state, ea->rc, fcport->login_gen, ea->sp->gen2,
4241             fcport->rscn_gen, ea->sp->gen1, vha->fcport_count);
4242
4243         if (fcport->disc_state == DSC_DELETE_PEND)
4244                 return;
4245
4246         if (ea->sp->gen2 != fcport->login_gen) {
4247                 /* target side must have changed it. */
4248                 ql_dbg(ql_dbg_disc, vha, 0x20d3,
4249                     "%s %8phC generation changed\n",
4250                     __func__, fcport->port_name);
4251                 return;
4252         } else if (ea->sp->gen1 != fcport->rscn_gen) {
4253                 return;
4254         }
4255
4256         qla24xx_post_gpsc_work(vha, fcport);
4257 }
4258
4259 static void qla2x00_async_gfpnid_sp_done(srb_t *sp, int res)
4260 {
4261         struct scsi_qla_host *vha = sp->vha;
4262         fc_port_t *fcport = sp->fcport;
4263         u8 *fpn = fcport->ct_desc.ct_sns->p.rsp.rsp.gfpn_id.port_name;
4264         struct event_arg ea;
4265         u64 wwn;
4266
4267         wwn = wwn_to_u64(fpn);
4268         if (wwn)
4269                 memcpy(fcport->fabric_port_name, fpn, WWN_SIZE);
4270
4271         memset(&ea, 0, sizeof(ea));
4272         ea.fcport = fcport;
4273         ea.sp = sp;
4274         ea.rc = res;
4275
4276         ql_dbg(ql_dbg_disc, vha, 0x204f,
4277             "Async done-%s res %x, WWPN %8phC %8phC\n",
4278             sp->name, res, fcport->port_name, fcport->fabric_port_name);
4279
4280         qla24xx_handle_gfpnid_event(vha, &ea);
4281
4282         sp->free(sp);
4283 }
4284
4285 int qla24xx_async_gfpnid(scsi_qla_host_t *vha, fc_port_t *fcport)
4286 {
4287         int rval = QLA_FUNCTION_FAILED;
4288         struct ct_sns_req       *ct_req;
4289         srb_t *sp;
4290
4291         if (!vha->flags.online || (fcport->flags & FCF_ASYNC_SENT))
4292                 return rval;
4293
4294         sp = qla2x00_get_sp(vha, fcport, GFP_ATOMIC);
4295         if (!sp)
4296                 goto done;
4297
4298         sp->type = SRB_CT_PTHRU_CMD;
4299         sp->name = "gfpnid";
4300         sp->gen1 = fcport->rscn_gen;
4301         sp->gen2 = fcport->login_gen;
4302
4303         sp->u.iocb_cmd.timeout = qla2x00_async_iocb_timeout;
4304         qla2x00_init_timer(sp, qla2x00_get_async_timeout(vha) + 2);
4305
4306         /* CT_IU preamble  */
4307         ct_req = qla2x00_prep_ct_req(fcport->ct_desc.ct_sns, GFPN_ID_CMD,
4308             GFPN_ID_RSP_SIZE);
4309
4310         /* GFPN_ID req */
4311         ct_req->req.port_id.port_id = port_id_to_be_id(fcport->d_id);
4312
4313
4314         /* req & rsp use the same buffer */
4315         sp->u.iocb_cmd.u.ctarg.req = fcport->ct_desc.ct_sns;
4316         sp->u.iocb_cmd.u.ctarg.req_dma = fcport->ct_desc.ct_sns_dma;
4317         sp->u.iocb_cmd.u.ctarg.rsp = fcport->ct_desc.ct_sns;
4318         sp->u.iocb_cmd.u.ctarg.rsp_dma = fcport->ct_desc.ct_sns_dma;
4319         sp->u.iocb_cmd.u.ctarg.req_size = GFPN_ID_REQ_SIZE;
4320         sp->u.iocb_cmd.u.ctarg.rsp_size = GFPN_ID_RSP_SIZE;
4321         sp->u.iocb_cmd.u.ctarg.nport_handle = NPH_SNS;
4322
4323         sp->done = qla2x00_async_gfpnid_sp_done;
4324
4325         ql_dbg(ql_dbg_disc, vha, 0xffff,
4326             "Async-%s - %8phC hdl=%x loopid=%x portid %06x.\n",
4327             sp->name, fcport->port_name,
4328             sp->handle, fcport->loop_id, fcport->d_id.b24);
4329
4330         rval = qla2x00_start_sp(sp);
4331         if (rval != QLA_SUCCESS)
4332                 goto done_free_sp;
4333
4334         return rval;
4335
4336 done_free_sp:
4337         sp->free(sp);
4338 done:
4339         return rval;
4340 }
4341
4342 int qla24xx_post_gfpnid_work(struct scsi_qla_host *vha, fc_port_t *fcport)
4343 {
4344         struct qla_work_evt *e;
4345         int ls;
4346
4347         ls = atomic_read(&vha->loop_state);
4348         if (((ls != LOOP_READY) && (ls != LOOP_UP)) ||
4349                 test_bit(UNLOADING, &vha->dpc_flags))
4350                 return 0;
4351
4352         e = qla2x00_alloc_work(vha, QLA_EVT_GFPNID);
4353         if (!e)
4354                 return QLA_FUNCTION_FAILED;
4355
4356         e->u.fcport.fcport = fcport;
4357         return qla2x00_post_work(vha, e);
4358 }