git.oblomov.eu Git - linux-2.6/blob - drivers/scsi/qla2xxx/qla_gs.c

   1 /*
   2  * QLogic Fibre Channel HBA Driver
   3  * Copyright (c)  2003-2005 QLogic Corporation
   4  *
   5  * See LICENSE.qla2xxx for copyright and licensing details.
   6  */
   7 #include "qla_def.h"
   8
   9 static inline struct ct_sns_req *
  10 qla2x00_prep_ct_req(struct ct_sns_req *, uint16_t, uint16_t);
  11
  12 static inline struct sns_cmd_pkt *
  13 qla2x00_prep_sns_cmd(scsi_qla_host_t *, uint16_t, uint16_t, uint16_t);
  14
  15 static int qla2x00_sns_ga_nxt(scsi_qla_host_t *, fc_port_t *);
  16 static int qla2x00_sns_gid_pt(scsi_qla_host_t *, sw_info_t *);
  17 static int qla2x00_sns_gpn_id(scsi_qla_host_t *, sw_info_t *);
  18 static int qla2x00_sns_gnn_id(scsi_qla_host_t *, sw_info_t *);
  19 static int qla2x00_sns_rft_id(scsi_qla_host_t *);
  20 static int qla2x00_sns_rnn_id(scsi_qla_host_t *);
  21
  22 /**
  23  * qla2x00_prep_ms_iocb() - Prepare common MS/CT IOCB fields for SNS CT query.
  24  * @ha: HA context
  25  * @req_size: request size in bytes
  26  * @rsp_size: response size in bytes
  27  *
  28  * Returns a pointer to the @ha's ms_iocb.
  29  */
  30 void *
  31 qla2x00_prep_ms_iocb(scsi_qla_host_t *ha, uint32_t req_size, uint32_t rsp_size)
  32 {
  33         ms_iocb_entry_t *ms_pkt;
  34
  35         ms_pkt = ha->ms_iocb;
  36         memset(ms_pkt, 0, sizeof(ms_iocb_entry_t));
  37
  38         ms_pkt->entry_type = MS_IOCB_TYPE;
  39         ms_pkt->entry_count = 1;
  40         SET_TARGET_ID(ha, ms_pkt->loop_id, SIMPLE_NAME_SERVER);
  41         ms_pkt->control_flags = __constant_cpu_to_le16(CF_READ | CF_HEAD_TAG);
  42         ms_pkt->timeout = __constant_cpu_to_le16(25);
  43         ms_pkt->cmd_dsd_count = __constant_cpu_to_le16(1);
  44         ms_pkt->total_dsd_count = __constant_cpu_to_le16(2);
  45         ms_pkt->rsp_bytecount = cpu_to_le32(rsp_size);
  46         ms_pkt->req_bytecount = cpu_to_le32(req_size);
  47
  48         ms_pkt->dseg_req_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
  49         ms_pkt->dseg_req_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
  50         ms_pkt->dseg_req_length = ms_pkt->req_bytecount;
  51
  52         ms_pkt->dseg_rsp_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
  53         ms_pkt->dseg_rsp_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
  54         ms_pkt->dseg_rsp_length = ms_pkt->rsp_bytecount;
  55
  56         return (ms_pkt);
  57 }
  58
  59 /**
  60  * qla24xx_prep_ms_iocb() - Prepare common CT IOCB fields for SNS CT query.
  61  * @ha: HA context
  62  * @req_size: request size in bytes
  63  * @rsp_size: response size in bytes
  64  *
  65  * Returns a pointer to the @ha's ms_iocb.
  66  */
  67 void *
  68 qla24xx_prep_ms_iocb(scsi_qla_host_t *ha, uint32_t req_size, uint32_t rsp_size)
  69 {
  70         struct ct_entry_24xx *ct_pkt;
  71
  72         ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
  73         memset(ct_pkt, 0, sizeof(struct ct_entry_24xx));
  74
  75         ct_pkt->entry_type = CT_IOCB_TYPE;
  76         ct_pkt->entry_count = 1;
  77         ct_pkt->nport_handle = __constant_cpu_to_le16(NPH_SNS);
  78         ct_pkt->timeout = __constant_cpu_to_le16(25);
  79         ct_pkt->cmd_dsd_count = __constant_cpu_to_le16(1);
  80         ct_pkt->rsp_dsd_count = __constant_cpu_to_le16(1);
  81         ct_pkt->rsp_byte_count = cpu_to_le32(rsp_size);
  82         ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
  83
  84         ct_pkt->dseg_0_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
  85         ct_pkt->dseg_0_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
  86         ct_pkt->dseg_0_len = ct_pkt->cmd_byte_count;
  87
  88         ct_pkt->dseg_1_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
  89         ct_pkt->dseg_1_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
  90         ct_pkt->dseg_1_len = ct_pkt->rsp_byte_count;
  91
  92         return (ct_pkt);
  93 }
  94
  95 /**
  96  * qla2x00_prep_ct_req() - Prepare common CT request fields for SNS query.
  97  * @ct_req: CT request buffer
  98  * @cmd: GS command
  99  * @rsp_size: response size in bytes
 100  *
 101  * Returns a pointer to the intitialized @ct_req.
 102  */
 103 static inline struct ct_sns_req *
 104 qla2x00_prep_ct_req(struct ct_sns_req *ct_req, uint16_t cmd, uint16_t rsp_size)
 105 {
 106         memset(ct_req, 0, sizeof(struct ct_sns_pkt));
 107
 108         ct_req->header.revision = 0x01;
 109         ct_req->header.gs_type = 0xFC;
 110         ct_req->header.gs_subtype = 0x02;
 111         ct_req->command = cpu_to_be16(cmd);
 112         ct_req->max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
 113
 114         return (ct_req);
 115 }
 116
 117 static int
 118 qla2x00_chk_ms_status(scsi_qla_host_t *ha, ms_iocb_entry_t *ms_pkt,
 119     struct ct_sns_rsp *ct_rsp, const char *routine)
 120 {
 121         int rval;
 122         uint16_t comp_status;
 123
 124         rval = QLA_FUNCTION_FAILED;
 125         if (ms_pkt->entry_status != 0) {
 126                 DEBUG2_3(printk("scsi(%ld): %s failed, error status (%x).\n",
 127                     ha->host_no, routine, ms_pkt->entry_status));
 128         } else {
 129                 if (IS_QLA24XX(ha) || IS_QLA54XX(ha))
 130                         comp_status = le16_to_cpu(
 131                             ((struct ct_entry_24xx *)ms_pkt)->comp_status);
 132                 else
 133                         comp_status = le16_to_cpu(ms_pkt->status);
 134                 switch (comp_status) {
 135                 case CS_COMPLETE:
 136                 case CS_DATA_UNDERRUN:
 137                 case CS_DATA_OVERRUN:           /* Overrun? */
 138                         if (ct_rsp->header.response !=
 139                             __constant_cpu_to_be16(CT_ACCEPT_RESPONSE)) {
 140                                 DEBUG2_3(printk("scsi(%ld): %s failed, "
 141                                     "rejected request:\n", ha->host_no,
 142                                     routine));
 143                                 DEBUG2_3(qla2x00_dump_buffer(
 144                                     (uint8_t *)&ct_rsp->header,
 145                                     sizeof(struct ct_rsp_hdr)));
 146                                 rval = QLA_INVALID_COMMAND;
 147                         } else
 148                                 rval = QLA_SUCCESS;
 149                         break;
 150                 default:
 151                         DEBUG2_3(printk("scsi(%ld): %s failed, completion "
 152                             "status (%x).\n", ha->host_no, routine,
 153                             comp_status));
 154                         break;
 155                 }
 156         }
 157         return rval;
 158 }
 159
 160 /**
 161  * qla2x00_ga_nxt() - SNS scan for fabric devices via GA_NXT command.
 162  * @ha: HA context
 163  * @fcport: fcport entry to updated
 164  *
 165  * Returns 0 on success.
 166  */
 167 int
 168 qla2x00_ga_nxt(scsi_qla_host_t *ha, fc_port_t *fcport)
 169 {
 170         int             rval;
 171
 172         ms_iocb_entry_t *ms_pkt;
 173         struct ct_sns_req       *ct_req;
 174         struct ct_sns_rsp       *ct_rsp;
 175
 176         if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 177                 return (qla2x00_sns_ga_nxt(ha, fcport));
 178         }
 179
 180         /* Issue GA_NXT */
 181         /* Prepare common MS IOCB */
 182         ms_pkt = ha->isp_ops.prep_ms_iocb(ha, GA_NXT_REQ_SIZE, GA_NXT_RSP_SIZE);
 183
 184         /* Prepare CT request */
 185         ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, GA_NXT_CMD,
 186             GA_NXT_RSP_SIZE);
 187         ct_rsp = &ha->ct_sns->p.rsp;
 188
 189         /* Prepare CT arguments -- port_id */
 190         ct_req->req.port_id.port_id[0] = fcport->d_id.b.domain;
 191         ct_req->req.port_id.port_id[1] = fcport->d_id.b.area;
 192         ct_req->req.port_id.port_id[2] = fcport->d_id.b.al_pa;
 193
 194         /* Execute MS IOCB */
 195         rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
 196             sizeof(ms_iocb_entry_t));
 197         if (rval != QLA_SUCCESS) {
 198                 /*EMPTY*/
 199                 DEBUG2_3(printk("scsi(%ld): GA_NXT issue IOCB failed (%d).\n",
 200                     ha->host_no, rval));
 201         } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "GA_NXT") !=
 202             QLA_SUCCESS) {
 203                 rval = QLA_FUNCTION_FAILED;
 204         } else {
 205                 /* Populate fc_port_t entry. */
 206                 fcport->d_id.b.domain = ct_rsp->rsp.ga_nxt.port_id[0];
 207                 fcport->d_id.b.area = ct_rsp->rsp.ga_nxt.port_id[1];
 208                 fcport->d_id.b.al_pa = ct_rsp->rsp.ga_nxt.port_id[2];
 209
 210                 memcpy(fcport->node_name, ct_rsp->rsp.ga_nxt.node_name,
 211                     WWN_SIZE);
 212                 memcpy(fcport->port_name, ct_rsp->rsp.ga_nxt.port_name,
 213                     WWN_SIZE);
 214
 215                 if (ct_rsp->rsp.ga_nxt.port_type != NS_N_PORT_TYPE &&
 216                     ct_rsp->rsp.ga_nxt.port_type != NS_NL_PORT_TYPE)
 217                         fcport->d_id.b.domain = 0xf0;
 218
 219                 DEBUG2_3(printk("scsi(%ld): GA_NXT entry - "
 220                     "nn %02x%02x%02x%02x%02x%02x%02x%02x "
 221                     "pn %02x%02x%02x%02x%02x%02x%02x%02x "
 222                     "portid=%02x%02x%02x.\n",
 223                     ha->host_no,
 224                     fcport->node_name[0], fcport->node_name[1],
 225                     fcport->node_name[2], fcport->node_name[3],
 226                     fcport->node_name[4], fcport->node_name[5],
 227                     fcport->node_name[6], fcport->node_name[7],
 228                     fcport->port_name[0], fcport->port_name[1],
 229                     fcport->port_name[2], fcport->port_name[3],
 230                     fcport->port_name[4], fcport->port_name[5],
 231                     fcport->port_name[6], fcport->port_name[7],
 232                     fcport->d_id.b.domain, fcport->d_id.b.area,
 233                     fcport->d_id.b.al_pa));
 234         }
 235
 236         return (rval);
 237 }
 238
 239 /**
 240  * qla2x00_gid_pt() - SNS scan for fabric devices via GID_PT command.
 241  * @ha: HA context
 242  * @list: switch info entries to populate
 243  *
 244  * NOTE: Non-Nx_Ports are not requested.
 245  *
 246  * Returns 0 on success.
 247  */
 248 int
 249 qla2x00_gid_pt(scsi_qla_host_t *ha, sw_info_t *list)
 250 {
 251         int             rval;
 252         uint16_t        i;
 253
 254         ms_iocb_entry_t *ms_pkt;
 255         struct ct_sns_req       *ct_req;
 256         struct ct_sns_rsp       *ct_rsp;
 257
 258         struct ct_sns_gid_pt_data *gid_data;
 259
 260         if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 261                 return (qla2x00_sns_gid_pt(ha, list));
 262         }
 263
 264         gid_data = NULL;
 265
 266         /* Issue GID_PT */
 267         /* Prepare common MS IOCB */
 268         ms_pkt = ha->isp_ops.prep_ms_iocb(ha, GID_PT_REQ_SIZE, GID_PT_RSP_SIZE);
 269
 270         /* Prepare CT request */
 271         ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, GID_PT_CMD,
 272             GID_PT_RSP_SIZE);
 273         ct_rsp = &ha->ct_sns->p.rsp;
 274
 275         /* Prepare CT arguments -- port_type */
 276         ct_req->req.gid_pt.port_type = NS_NX_PORT_TYPE;
 277
 278         /* Execute MS IOCB */
 279         rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
 280             sizeof(ms_iocb_entry_t));
 281         if (rval != QLA_SUCCESS) {
 282                 /*EMPTY*/
 283                 DEBUG2_3(printk("scsi(%ld): GID_PT issue IOCB failed (%d).\n",
 284                     ha->host_no, rval));
 285         } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "GID_PT") !=
 286             QLA_SUCCESS) {
 287                 rval = QLA_FUNCTION_FAILED;
 288         } else {
 289                 /* Set port IDs in switch info list. */
 290                 for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
 291                         gid_data = &ct_rsp->rsp.gid_pt.entries[i];
 292                         list[i].d_id.b.domain = gid_data->port_id[0];
 293                         list[i].d_id.b.area = gid_data->port_id[1];
 294                         list[i].d_id.b.al_pa = gid_data->port_id[2];
 295
 296                         /* Last one exit. */
 297                         if (gid_data->control_byte & BIT_7) {
 298                                 list[i].d_id.b.rsvd_1 = gid_data->control_byte;
 299                                 break;
 300                         }
 301                 }
 302
 303                 /*
 304                  * If we've used all available slots, then the switch is
 305                  * reporting back more devices than we can handle with this
 306                  * single call.  Return a failed status, and let GA_NXT handle
 307                  * the overload.
 308                  */
 309                 if (i == MAX_FIBRE_DEVICES)
 310                         rval = QLA_FUNCTION_FAILED;
 311         }
 312
 313         return (rval);
 314 }
 315
 316 /**
 317  * qla2x00_gpn_id() - SNS Get Port Name (GPN_ID) query.
 318  * @ha: HA context
 319  * @list: switch info entries to populate
 320  *
 321  * Returns 0 on success.
 322  */
 323 int
 324 qla2x00_gpn_id(scsi_qla_host_t *ha, sw_info_t *list)
 325 {
 326         int             rval;
 327         uint16_t        i;
 328
 329         ms_iocb_entry_t *ms_pkt;
 330         struct ct_sns_req       *ct_req;
 331         struct ct_sns_rsp       *ct_rsp;
 332
 333         if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 334                 return (qla2x00_sns_gpn_id(ha, list));
 335         }
 336
 337         for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
 338                 /* Issue GPN_ID */
 339                 /* Prepare common MS IOCB */
 340                 ms_pkt = ha->isp_ops.prep_ms_iocb(ha, GPN_ID_REQ_SIZE,
 341                     GPN_ID_RSP_SIZE);
 342
 343                 /* Prepare CT request */
 344                 ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, GPN_ID_CMD,
 345                     GPN_ID_RSP_SIZE);
 346                 ct_rsp = &ha->ct_sns->p.rsp;
 347
 348                 /* Prepare CT arguments -- port_id */
 349                 ct_req->req.port_id.port_id[0] = list[i].d_id.b.domain;
 350                 ct_req->req.port_id.port_id[1] = list[i].d_id.b.area;
 351                 ct_req->req.port_id.port_id[2] = list[i].d_id.b.al_pa;
 352
 353                 /* Execute MS IOCB */
 354                 rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
 355                     sizeof(ms_iocb_entry_t));
 356                 if (rval != QLA_SUCCESS) {
 357                         /*EMPTY*/
 358                         DEBUG2_3(printk("scsi(%ld): GPN_ID issue IOCB failed "
 359                             "(%d).\n", ha->host_no, rval));
 360                 } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp,
 361                     "GPN_ID") != QLA_SUCCESS) {
 362                         rval = QLA_FUNCTION_FAILED;
 363                 } else {
 364                         /* Save portname */
 365                         memcpy(list[i].port_name,
 366                             ct_rsp->rsp.gpn_id.port_name, WWN_SIZE);
 367                 }
 368
 369                 /* Last device exit. */
 370                 if (list[i].d_id.b.rsvd_1 != 0)
 371                         break;
 372         }
 373
 374         return (rval);
 375 }
 376
 377 /**
 378  * qla2x00_gnn_id() - SNS Get Node Name (GNN_ID) query.
 379  * @ha: HA context
 380  * @list: switch info entries to populate
 381  *
 382  * Returns 0 on success.
 383  */
 384 int
 385 qla2x00_gnn_id(scsi_qla_host_t *ha, sw_info_t *list)
 386 {
 387         int             rval;
 388         uint16_t        i;
 389
 390         ms_iocb_entry_t *ms_pkt;
 391         struct ct_sns_req       *ct_req;
 392         struct ct_sns_rsp       *ct_rsp;
 393
 394         if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 395                 return (qla2x00_sns_gnn_id(ha, list));
 396         }
 397
 398         for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
 399                 /* Issue GNN_ID */
 400                 /* Prepare common MS IOCB */
 401                 ms_pkt = ha->isp_ops.prep_ms_iocb(ha, GNN_ID_REQ_SIZE,
 402                     GNN_ID_RSP_SIZE);
 403
 404                 /* Prepare CT request */
 405                 ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, GNN_ID_CMD,
 406                     GNN_ID_RSP_SIZE);
 407                 ct_rsp = &ha->ct_sns->p.rsp;
 408
 409                 /* Prepare CT arguments -- port_id */
 410                 ct_req->req.port_id.port_id[0] = list[i].d_id.b.domain;
 411                 ct_req->req.port_id.port_id[1] = list[i].d_id.b.area;
 412                 ct_req->req.port_id.port_id[2] = list[i].d_id.b.al_pa;
 413
 414                 /* Execute MS IOCB */
 415                 rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
 416                     sizeof(ms_iocb_entry_t));
 417                 if (rval != QLA_SUCCESS) {
 418                         /*EMPTY*/
 419                         DEBUG2_3(printk("scsi(%ld): GNN_ID issue IOCB failed "
 420                             "(%d).\n", ha->host_no, rval));
 421                 } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp,
 422                     "GNN_ID") != QLA_SUCCESS) {
 423                         rval = QLA_FUNCTION_FAILED;
 424                 } else {
 425                         /* Save nodename */
 426                         memcpy(list[i].node_name,
 427                             ct_rsp->rsp.gnn_id.node_name, WWN_SIZE);
 428
 429                         DEBUG2_3(printk("scsi(%ld): GID_PT entry - "
 430                             "nn %02x%02x%02x%02x%02x%02x%02x%02x "
 431                             "pn %02x%02x%02x%02x%02x%02x%02x%02x "
 432                             "portid=%02x%02x%02x.\n",
 433                             ha->host_no,
 434                             list[i].node_name[0], list[i].node_name[1],
 435                             list[i].node_name[2], list[i].node_name[3],
 436                             list[i].node_name[4], list[i].node_name[5],
 437                             list[i].node_name[6], list[i].node_name[7],
 438                             list[i].port_name[0], list[i].port_name[1],
 439                             list[i].port_name[2], list[i].port_name[3],
 440                             list[i].port_name[4], list[i].port_name[5],
 441                             list[i].port_name[6], list[i].port_name[7],
 442                             list[i].d_id.b.domain, list[i].d_id.b.area,
 443                             list[i].d_id.b.al_pa));
 444                 }
 445
 446                 /* Last device exit. */
 447                 if (list[i].d_id.b.rsvd_1 != 0)
 448                         break;
 449         }
 450
 451         return (rval);
 452 }
 453
 454 /**
 455  * qla2x00_rft_id() - SNS Register FC-4 TYPEs (RFT_ID) supported by the HBA.
 456  * @ha: HA context
 457  *
 458  * Returns 0 on success.
 459  */
 460 int
 461 qla2x00_rft_id(scsi_qla_host_t *ha)
 462 {
 463         int             rval;
 464
 465         ms_iocb_entry_t *ms_pkt;
 466         struct ct_sns_req       *ct_req;
 467         struct ct_sns_rsp       *ct_rsp;
 468
 469         if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 470                 return (qla2x00_sns_rft_id(ha));
 471         }
 472
 473         /* Issue RFT_ID */
 474         /* Prepare common MS IOCB */
 475         ms_pkt = ha->isp_ops.prep_ms_iocb(ha, RFT_ID_REQ_SIZE, RFT_ID_RSP_SIZE);
 476
 477         /* Prepare CT request */
 478         ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, RFT_ID_CMD,
 479             RFT_ID_RSP_SIZE);
 480         ct_rsp = &ha->ct_sns->p.rsp;
 481
 482         /* Prepare CT arguments -- port_id, FC-4 types */
 483         ct_req->req.rft_id.port_id[0] = ha->d_id.b.domain;
 484         ct_req->req.rft_id.port_id[1] = ha->d_id.b.area;
 485         ct_req->req.rft_id.port_id[2] = ha->d_id.b.al_pa;
 486
 487         ct_req->req.rft_id.fc4_types[2] = 0x01;         /* FCP-3 */
 488
 489         /* Execute MS IOCB */
 490         rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
 491             sizeof(ms_iocb_entry_t));
 492         if (rval != QLA_SUCCESS) {
 493                 /*EMPTY*/
 494                 DEBUG2_3(printk("scsi(%ld): RFT_ID issue IOCB failed (%d).\n",
 495                     ha->host_no, rval));
 496         } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RFT_ID") !=
 497             QLA_SUCCESS) {
 498                 rval = QLA_FUNCTION_FAILED;
 499         } else {
 500                 DEBUG2(printk("scsi(%ld): RFT_ID exiting normally.\n",
 501                     ha->host_no));
 502         }
 503
 504         return (rval);
 505 }
 506
 507 /**
 508  * qla2x00_rff_id() - SNS Register FC-4 Features (RFF_ID) supported by the HBA.
 509  * @ha: HA context
 510  *
 511  * Returns 0 on success.
 512  */
 513 int
 514 qla2x00_rff_id(scsi_qla_host_t *ha)
 515 {
 516         int             rval;
 517
 518         ms_iocb_entry_t *ms_pkt;
 519         struct ct_sns_req       *ct_req;
 520         struct ct_sns_rsp       *ct_rsp;
 521
 522         if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 523                 DEBUG2(printk("scsi(%ld): RFF_ID call unsupported on "
 524                     "ISP2100/ISP2200.\n", ha->host_no));
 525                 return (QLA_SUCCESS);
 526         }
 527
 528         /* Issue RFF_ID */
 529         /* Prepare common MS IOCB */
 530         ms_pkt = ha->isp_ops.prep_ms_iocb(ha, RFF_ID_REQ_SIZE, RFF_ID_RSP_SIZE);
 531
 532         /* Prepare CT request */
 533         ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, RFF_ID_CMD,
 534             RFF_ID_RSP_SIZE);
 535         ct_rsp = &ha->ct_sns->p.rsp;
 536
 537         /* Prepare CT arguments -- port_id, FC-4 feature, FC-4 type */
 538         ct_req->req.rff_id.port_id[0] = ha->d_id.b.domain;
 539         ct_req->req.rff_id.port_id[1] = ha->d_id.b.area;
 540         ct_req->req.rff_id.port_id[2] = ha->d_id.b.al_pa;
 541
 542         ct_req->req.rff_id.fc4_feature = BIT_1;
 543         ct_req->req.rff_id.fc4_type = 0x08;             /* SCSI - FCP */
 544
 545         /* Execute MS IOCB */
 546         rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
 547             sizeof(ms_iocb_entry_t));
 548         if (rval != QLA_SUCCESS) {
 549                 /*EMPTY*/
 550                 DEBUG2_3(printk("scsi(%ld): RFF_ID issue IOCB failed (%d).\n",
 551                     ha->host_no, rval));
 552         } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RFF_ID") !=
 553             QLA_SUCCESS) {
 554                 rval = QLA_FUNCTION_FAILED;
 555         } else {
 556                 DEBUG2(printk("scsi(%ld): RFF_ID exiting normally.\n",
 557                     ha->host_no));
 558         }
 559
 560         return (rval);
 561 }
 562
 563 /**
 564  * qla2x00_rnn_id() - SNS Register Node Name (RNN_ID) of the HBA.
 565  * @ha: HA context
 566  *
 567  * Returns 0 on success.
 568  */
 569 int
 570 qla2x00_rnn_id(scsi_qla_host_t *ha)
 571 {
 572         int             rval;
 573
 574         ms_iocb_entry_t *ms_pkt;
 575         struct ct_sns_req       *ct_req;
 576         struct ct_sns_rsp       *ct_rsp;
 577
 578         if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 579                 return (qla2x00_sns_rnn_id(ha));
 580         }
 581
 582         /* Issue RNN_ID */
 583         /* Prepare common MS IOCB */
 584         ms_pkt = ha->isp_ops.prep_ms_iocb(ha, RNN_ID_REQ_SIZE, RNN_ID_RSP_SIZE);
 585
 586         /* Prepare CT request */
 587         ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, RNN_ID_CMD,
 588             RNN_ID_RSP_SIZE);
 589         ct_rsp = &ha->ct_sns->p.rsp;
 590
 591         /* Prepare CT arguments -- port_id, node_name */
 592         ct_req->req.rnn_id.port_id[0] = ha->d_id.b.domain;
 593         ct_req->req.rnn_id.port_id[1] = ha->d_id.b.area;
 594         ct_req->req.rnn_id.port_id[2] = ha->d_id.b.al_pa;
 595
 596         memcpy(ct_req->req.rnn_id.node_name, ha->node_name, WWN_SIZE);
 597
 598         /* Execute MS IOCB */
 599         rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
 600             sizeof(ms_iocb_entry_t));
 601         if (rval != QLA_SUCCESS) {
 602                 /*EMPTY*/
 603                 DEBUG2_3(printk("scsi(%ld): RNN_ID issue IOCB failed (%d).\n",
 604                     ha->host_no, rval));
 605         } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RNN_ID") !=
 606             QLA_SUCCESS) {
 607                 rval = QLA_FUNCTION_FAILED;
 608         } else {
 609                 DEBUG2(printk("scsi(%ld): RNN_ID exiting normally.\n",
 610                     ha->host_no));
 611         }
 612
 613         return (rval);
 614 }
 615
 616 void
 617 qla2x00_get_sym_node_name(scsi_qla_host_t *ha, uint8_t *snn)
 618 {
 619         sprintf(snn, "%s FW:v%d.%02d.%02d DVR:v%s",ha->model_number,
 620             ha->fw_major_version, ha->fw_minor_version,
 621             ha->fw_subminor_version, qla2x00_version_str);
 622 }
 623
 624 /**
 625  * qla2x00_rsnn_nn() - SNS Register Symbolic Node Name (RSNN_NN) of the HBA.
 626  * @ha: HA context
 627  *
 628  * Returns 0 on success.
 629  */
 630 int
 631 qla2x00_rsnn_nn(scsi_qla_host_t *ha)
 632 {
 633         int             rval;
 634         ms_iocb_entry_t *ms_pkt;
 635         struct ct_sns_req       *ct_req;
 636         struct ct_sns_rsp       *ct_rsp;
 637
 638         if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 639                 DEBUG2(printk("scsi(%ld): RSNN_ID call unsupported on "
 640                     "ISP2100/ISP2200.\n", ha->host_no));
 641                 return (QLA_SUCCESS);
 642         }
 643
 644         /* Issue RSNN_NN */
 645         /* Prepare common MS IOCB */
 646         /*   Request size adjusted after CT preparation */
 647         ms_pkt = ha->isp_ops.prep_ms_iocb(ha, 0, RSNN_NN_RSP_SIZE);
 648
 649         /* Prepare CT request */
 650         ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, RSNN_NN_CMD,
 651             RSNN_NN_RSP_SIZE);
 652         ct_rsp = &ha->ct_sns->p.rsp;
 653
 654         /* Prepare CT arguments -- node_name, symbolic node_name, size */
 655         memcpy(ct_req->req.rsnn_nn.node_name, ha->node_name, WWN_SIZE);
 656
 657         /* Prepare the Symbolic Node Name */
 658         qla2x00_get_sym_node_name(ha, ct_req->req.rsnn_nn.sym_node_name);
 659
 660         /* Calculate SNN length */
 661         ct_req->req.rsnn_nn.name_len =
 662             (uint8_t)strlen(ct_req->req.rsnn_nn.sym_node_name);
 663
 664         /* Update MS IOCB request */
 665         ms_pkt->req_bytecount =
 666             cpu_to_le32(24 + 1 + ct_req->req.rsnn_nn.name_len);
 667         ms_pkt->dseg_req_length = ms_pkt->req_bytecount;
 668
 669         /* Execute MS IOCB */
 670         rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
 671             sizeof(ms_iocb_entry_t));
 672         if (rval != QLA_SUCCESS) {
 673                 /*EMPTY*/
 674                 DEBUG2_3(printk("scsi(%ld): RSNN_NN issue IOCB failed (%d).\n",
 675                     ha->host_no, rval));
 676         } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RSNN_NN") !=
 677             QLA_SUCCESS) {
 678                 rval = QLA_FUNCTION_FAILED;
 679         } else {
 680                 DEBUG2(printk("scsi(%ld): RSNN_NN exiting normally.\n",
 681                     ha->host_no));
 682         }
 683
 684         return (rval);
 685 }
 686
 687 /**
 688  * qla2x00_prep_sns_cmd() - Prepare common SNS command request fields for query.
 689  * @ha: HA context
 690  * @cmd: GS command
 691  * @scmd_len: Subcommand length
 692  * @data_size: response size in bytes
 693  *
 694  * Returns a pointer to the @ha's sns_cmd.
 695  */
 696 static inline struct sns_cmd_pkt *
 697 qla2x00_prep_sns_cmd(scsi_qla_host_t *ha, uint16_t cmd, uint16_t scmd_len,
 698     uint16_t data_size)
 699 {
 700         uint16_t                wc;
 701         struct sns_cmd_pkt      *sns_cmd;
 702
 703         sns_cmd = ha->sns_cmd;
 704         memset(sns_cmd, 0, sizeof(struct sns_cmd_pkt));
 705         wc = data_size / 2;                     /* Size in 16bit words. */
 706         sns_cmd->p.cmd.buffer_length = cpu_to_le16(wc);
 707         sns_cmd->p.cmd.buffer_address[0] = cpu_to_le32(LSD(ha->sns_cmd_dma));
 708         sns_cmd->p.cmd.buffer_address[1] = cpu_to_le32(MSD(ha->sns_cmd_dma));
 709         sns_cmd->p.cmd.subcommand_length = cpu_to_le16(scmd_len);
 710         sns_cmd->p.cmd.subcommand = cpu_to_le16(cmd);
 711         wc = (data_size - 16) / 4;              /* Size in 32bit words. */
 712         sns_cmd->p.cmd.size = cpu_to_le16(wc);
 713
 714         return (sns_cmd);
 715 }
 716
 717 /**
 718  * qla2x00_sns_ga_nxt() - SNS scan for fabric devices via GA_NXT command.
 719  * @ha: HA context
 720  * @fcport: fcport entry to updated
 721  *
 722  * This command uses the old Exectute SNS Command mailbox routine.
 723  *
 724  * Returns 0 on success.
 725  */
 726 static int
 727 qla2x00_sns_ga_nxt(scsi_qla_host_t *ha, fc_port_t *fcport)
 728 {
 729         int             rval;
 730
 731         struct sns_cmd_pkt      *sns_cmd;
 732
 733         /* Issue GA_NXT. */
 734         /* Prepare SNS command request. */
 735         sns_cmd = qla2x00_prep_sns_cmd(ha, GA_NXT_CMD, GA_NXT_SNS_SCMD_LEN,
 736             GA_NXT_SNS_DATA_SIZE);
 737
 738         /* Prepare SNS command arguments -- port_id. */
 739         sns_cmd->p.cmd.param[0] = fcport->d_id.b.al_pa;
 740         sns_cmd->p.cmd.param[1] = fcport->d_id.b.area;
 741         sns_cmd->p.cmd.param[2] = fcport->d_id.b.domain;
 742
 743         /* Execute SNS command. */
 744         rval = qla2x00_send_sns(ha, ha->sns_cmd_dma, GA_NXT_SNS_CMD_SIZE / 2,
 745             sizeof(struct sns_cmd_pkt));
 746         if (rval != QLA_SUCCESS) {
 747                 /*EMPTY*/
 748                 DEBUG2_3(printk("scsi(%ld): GA_NXT Send SNS failed (%d).\n",
 749                     ha->host_no, rval));
 750         } else if (sns_cmd->p.gan_data[8] != 0x80 ||
 751             sns_cmd->p.gan_data[9] != 0x02) {
 752                 DEBUG2_3(printk("scsi(%ld): GA_NXT failed, rejected request, "
 753                     "ga_nxt_rsp:\n", ha->host_no));
 754                 DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.gan_data, 16));
 755                 rval = QLA_FUNCTION_FAILED;
 756         } else {
 757                 /* Populate fc_port_t entry. */
 758                 fcport->d_id.b.domain = sns_cmd->p.gan_data[17];
 759                 fcport->d_id.b.area = sns_cmd->p.gan_data[18];
 760                 fcport->d_id.b.al_pa = sns_cmd->p.gan_data[19];
 761
 762                 memcpy(fcport->node_name, &sns_cmd->p.gan_data[284], WWN_SIZE);
 763                 memcpy(fcport->port_name, &sns_cmd->p.gan_data[20], WWN_SIZE);
 764
 765                 if (sns_cmd->p.gan_data[16] != NS_N_PORT_TYPE &&
 766                     sns_cmd->p.gan_data[16] != NS_NL_PORT_TYPE)
 767                         fcport->d_id.b.domain = 0xf0;
 768
 769                 DEBUG2_3(printk("scsi(%ld): GA_NXT entry - "
 770                     "nn %02x%02x%02x%02x%02x%02x%02x%02x "
 771                     "pn %02x%02x%02x%02x%02x%02x%02x%02x "
 772                     "portid=%02x%02x%02x.\n",
 773                     ha->host_no,
 774                     fcport->node_name[0], fcport->node_name[1],
 775                     fcport->node_name[2], fcport->node_name[3],
 776                     fcport->node_name[4], fcport->node_name[5],
 777                     fcport->node_name[6], fcport->node_name[7],
 778                     fcport->port_name[0], fcport->port_name[1],
 779                     fcport->port_name[2], fcport->port_name[3],
 780                     fcport->port_name[4], fcport->port_name[5],
 781                     fcport->port_name[6], fcport->port_name[7],
 782                     fcport->d_id.b.domain, fcport->d_id.b.area,
 783                     fcport->d_id.b.al_pa));
 784         }
 785
 786         return (rval);
 787 }
 788
 789 /**
 790  * qla2x00_sns_gid_pt() - SNS scan for fabric devices via GID_PT command.
 791  * @ha: HA context
 792  * @list: switch info entries to populate
 793  *
 794  * This command uses the old Exectute SNS Command mailbox routine.
 795  *
 796  * NOTE: Non-Nx_Ports are not requested.
 797  *
 798  * Returns 0 on success.
 799  */
 800 static int
 801 qla2x00_sns_gid_pt(scsi_qla_host_t *ha, sw_info_t *list)
 802 {
 803         int             rval;
 804
 805         uint16_t        i;
 806         uint8_t         *entry;
 807         struct sns_cmd_pkt      *sns_cmd;
 808
 809         /* Issue GID_PT. */
 810         /* Prepare SNS command request. */
 811         sns_cmd = qla2x00_prep_sns_cmd(ha, GID_PT_CMD, GID_PT_SNS_SCMD_LEN,
 812             GID_PT_SNS_DATA_SIZE);
 813
 814         /* Prepare SNS command arguments -- port_type. */
 815         sns_cmd->p.cmd.param[0] = NS_NX_PORT_TYPE;
 816
 817         /* Execute SNS command. */
 818         rval = qla2x00_send_sns(ha, ha->sns_cmd_dma, GID_PT_SNS_CMD_SIZE / 2,
 819             sizeof(struct sns_cmd_pkt));
 820         if (rval != QLA_SUCCESS) {
 821                 /*EMPTY*/
 822                 DEBUG2_3(printk("scsi(%ld): GID_PT Send SNS failed (%d).\n",
 823                     ha->host_no, rval));
 824         } else if (sns_cmd->p.gid_data[8] != 0x80 ||
 825             sns_cmd->p.gid_data[9] != 0x02) {
 826                 DEBUG2_3(printk("scsi(%ld): GID_PT failed, rejected request, "
 827                     "gid_rsp:\n", ha->host_no));
 828                 DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.gid_data, 16));
 829                 rval = QLA_FUNCTION_FAILED;
 830         } else {
 831                 /* Set port IDs in switch info list. */
 832                 for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
 833                         entry = &sns_cmd->p.gid_data[(i * 4) + 16];
 834                         list[i].d_id.b.domain = entry[1];
 835                         list[i].d_id.b.area = entry[2];
 836                         list[i].d_id.b.al_pa = entry[3];
 837
 838                         /* Last one exit. */
 839                         if (entry[0] & BIT_7) {
 840                                 list[i].d_id.b.rsvd_1 = entry[0];
 841                                 break;
 842                         }
 843                 }
 844
 845                 /*
 846                  * If we've used all available slots, then the switch is
 847                  * reporting back more devices that we can handle with this
 848                  * single call.  Return a failed status, and let GA_NXT handle
 849                  * the overload.
 850                  */
 851                 if (i == MAX_FIBRE_DEVICES)
 852                         rval = QLA_FUNCTION_FAILED;
 853         }
 854
 855         return (rval);
 856 }
 857
 858 /**
 859  * qla2x00_sns_gpn_id() - SNS Get Port Name (GPN_ID) query.
 860  * @ha: HA context
 861  * @list: switch info entries to populate
 862  *
 863  * This command uses the old Exectute SNS Command mailbox routine.
 864  *
 865  * Returns 0 on success.
 866  */
 867 static int
 868 qla2x00_sns_gpn_id(scsi_qla_host_t *ha, sw_info_t *list)
 869 {
 870         int             rval;
 871
 872         uint16_t        i;
 873         struct sns_cmd_pkt      *sns_cmd;
 874
 875         for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
 876                 /* Issue GPN_ID */
 877                 /* Prepare SNS command request. */
 878                 sns_cmd = qla2x00_prep_sns_cmd(ha, GPN_ID_CMD,
 879                     GPN_ID_SNS_SCMD_LEN, GPN_ID_SNS_DATA_SIZE);
 880
 881                 /* Prepare SNS command arguments -- port_id. */
 882                 sns_cmd->p.cmd.param[0] = list[i].d_id.b.al_pa;
 883                 sns_cmd->p.cmd.param[1] = list[i].d_id.b.area;
 884                 sns_cmd->p.cmd.param[2] = list[i].d_id.b.domain;
 885
 886                 /* Execute SNS command. */
 887                 rval = qla2x00_send_sns(ha, ha->sns_cmd_dma,
 888                     GPN_ID_SNS_CMD_SIZE / 2, sizeof(struct sns_cmd_pkt));
 889                 if (rval != QLA_SUCCESS) {
 890                         /*EMPTY*/
 891                         DEBUG2_3(printk("scsi(%ld): GPN_ID Send SNS failed "
 892                             "(%d).\n", ha->host_no, rval));
 893                 } else if (sns_cmd->p.gpn_data[8] != 0x80 ||
 894                     sns_cmd->p.gpn_data[9] != 0x02) {
 895                         DEBUG2_3(printk("scsi(%ld): GPN_ID failed, rejected "
 896                             "request, gpn_rsp:\n", ha->host_no));
 897                         DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.gpn_data, 16));
 898                         rval = QLA_FUNCTION_FAILED;
 899                 } else {
 900                         /* Save portname */
 901                         memcpy(list[i].port_name, &sns_cmd->p.gpn_data[16],
 902                             WWN_SIZE);
 903                 }
 904
 905                 /* Last device exit. */
 906                 if (list[i].d_id.b.rsvd_1 != 0)
 907                         break;
 908         }
 909
 910         return (rval);
 911 }
 912
 913 /**
 914  * qla2x00_sns_gnn_id() - SNS Get Node Name (GNN_ID) query.
 915  * @ha: HA context
 916  * @list: switch info entries to populate
 917  *
 918  * This command uses the old Exectute SNS Command mailbox routine.
 919  *
 920  * Returns 0 on success.
 921  */
 922 static int
 923 qla2x00_sns_gnn_id(scsi_qla_host_t *ha, sw_info_t *list)
 924 {
 925         int             rval;
 926
 927         uint16_t        i;
 928         struct sns_cmd_pkt      *sns_cmd;
 929
 930         for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
 931                 /* Issue GNN_ID */
 932                 /* Prepare SNS command request. */
 933                 sns_cmd = qla2x00_prep_sns_cmd(ha, GNN_ID_CMD,
 934                     GNN_ID_SNS_SCMD_LEN, GNN_ID_SNS_DATA_SIZE);
 935
 936                 /* Prepare SNS command arguments -- port_id. */
 937                 sns_cmd->p.cmd.param[0] = list[i].d_id.b.al_pa;
 938                 sns_cmd->p.cmd.param[1] = list[i].d_id.b.area;
 939                 sns_cmd->p.cmd.param[2] = list[i].d_id.b.domain;
 940
 941                 /* Execute SNS command. */
 942                 rval = qla2x00_send_sns(ha, ha->sns_cmd_dma,
 943                     GNN_ID_SNS_CMD_SIZE / 2, sizeof(struct sns_cmd_pkt));
 944                 if (rval != QLA_SUCCESS) {
 945                         /*EMPTY*/
 946                         DEBUG2_3(printk("scsi(%ld): GNN_ID Send SNS failed "
 947                             "(%d).\n", ha->host_no, rval));
 948                 } else if (sns_cmd->p.gnn_data[8] != 0x80 ||
 949                     sns_cmd->p.gnn_data[9] != 0x02) {
 950                         DEBUG2_3(printk("scsi(%ld): GNN_ID failed, rejected "
 951                             "request, gnn_rsp:\n", ha->host_no));
 952                         DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.gnn_data, 16));
 953                         rval = QLA_FUNCTION_FAILED;
 954                 } else {
 955                         /* Save nodename */
 956                         memcpy(list[i].node_name, &sns_cmd->p.gnn_data[16],
 957                             WWN_SIZE);
 958
 959                         DEBUG2_3(printk("scsi(%ld): GID_PT entry - "
 960                             "nn %02x%02x%02x%02x%02x%02x%02x%02x "
 961                             "pn %02x%02x%02x%02x%02x%02x%02x%02x "
 962                             "portid=%02x%02x%02x.\n",
 963                             ha->host_no,
 964                             list[i].node_name[0], list[i].node_name[1],
 965                             list[i].node_name[2], list[i].node_name[3],
 966                             list[i].node_name[4], list[i].node_name[5],
 967                             list[i].node_name[6], list[i].node_name[7],
 968                             list[i].port_name[0], list[i].port_name[1],
 969                             list[i].port_name[2], list[i].port_name[3],
 970                             list[i].port_name[4], list[i].port_name[5],
 971                             list[i].port_name[6], list[i].port_name[7],
 972                             list[i].d_id.b.domain, list[i].d_id.b.area,
 973                             list[i].d_id.b.al_pa));
 974                 }
 975
 976                 /* Last device exit. */
 977                 if (list[i].d_id.b.rsvd_1 != 0)
 978                         break;
 979         }
 980
 981         return (rval);
 982 }
 983
 984 /**
 985  * qla2x00_snd_rft_id() - SNS Register FC-4 TYPEs (RFT_ID) supported by the HBA.
 986  * @ha: HA context
 987  *
 988  * This command uses the old Exectute SNS Command mailbox routine.
 989  *
 990  * Returns 0 on success.
 991  */
 992 static int
 993 qla2x00_sns_rft_id(scsi_qla_host_t *ha)
 994 {
 995         int             rval;
 996
 997         struct sns_cmd_pkt      *sns_cmd;
 998
 999         /* Issue RFT_ID. */
1000         /* Prepare SNS command request. */
1001         sns_cmd = qla2x00_prep_sns_cmd(ha, RFT_ID_CMD, RFT_ID_SNS_SCMD_LEN,
1002             RFT_ID_SNS_DATA_SIZE);
1003
1004         /* Prepare SNS command arguments -- port_id, FC-4 types */
1005         sns_cmd->p.cmd.param[0] = ha->d_id.b.al_pa;
1006         sns_cmd->p.cmd.param[1] = ha->d_id.b.area;
1007         sns_cmd->p.cmd.param[2] = ha->d_id.b.domain;
1008
1009         sns_cmd->p.cmd.param[5] = 0x01;                 /* FCP-3 */
1010
1011         /* Execute SNS command. */
1012         rval = qla2x00_send_sns(ha, ha->sns_cmd_dma, RFT_ID_SNS_CMD_SIZE / 2,
1013             sizeof(struct sns_cmd_pkt));
1014         if (rval != QLA_SUCCESS) {
1015                 /*EMPTY*/
1016                 DEBUG2_3(printk("scsi(%ld): RFT_ID Send SNS failed (%d).\n",
1017                     ha->host_no, rval));
1018         } else if (sns_cmd->p.rft_data[8] != 0x80 ||
1019             sns_cmd->p.rft_data[9] != 0x02) {
1020                 DEBUG2_3(printk("scsi(%ld): RFT_ID failed, rejected request, "
1021                     "rft_rsp:\n", ha->host_no));
1022                 DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.rft_data, 16));
1023                 rval = QLA_FUNCTION_FAILED;
1024         } else {
1025                 DEBUG2(printk("scsi(%ld): RFT_ID exiting normally.\n",
1026                     ha->host_no));
1027         }
1028
1029         return (rval);
1030 }
1031
1032 /**
1033  * qla2x00_sns_rnn_id() - SNS Register Node Name (RNN_ID) of the HBA.
1034  * HBA.
1035  * @ha: HA context
1036  *
1037  * This command uses the old Exectute SNS Command mailbox routine.
1038  *
1039  * Returns 0 on success.
1040  */
1041 static int
1042 qla2x00_sns_rnn_id(scsi_qla_host_t *ha)
1043 {
1044         int             rval;
1045
1046         struct sns_cmd_pkt      *sns_cmd;
1047
1048         /* Issue RNN_ID. */
1049         /* Prepare SNS command request. */
1050         sns_cmd = qla2x00_prep_sns_cmd(ha, RNN_ID_CMD, RNN_ID_SNS_SCMD_LEN,
1051             RNN_ID_SNS_DATA_SIZE);
1052
1053         /* Prepare SNS command arguments -- port_id, nodename. */
1054         sns_cmd->p.cmd.param[0] = ha->d_id.b.al_pa;
1055         sns_cmd->p.cmd.param[1] = ha->d_id.b.area;
1056         sns_cmd->p.cmd.param[2] = ha->d_id.b.domain;
1057
1058         sns_cmd->p.cmd.param[4] = ha->node_name[7];
1059         sns_cmd->p.cmd.param[5] = ha->node_name[6];
1060         sns_cmd->p.cmd.param[6] = ha->node_name[5];
1061         sns_cmd->p.cmd.param[7] = ha->node_name[4];
1062         sns_cmd->p.cmd.param[8] = ha->node_name[3];
1063         sns_cmd->p.cmd.param[9] = ha->node_name[2];
1064         sns_cmd->p.cmd.param[10] = ha->node_name[1];
1065         sns_cmd->p.cmd.param[11] = ha->node_name[0];
1066
1067         /* Execute SNS command. */
1068         rval = qla2x00_send_sns(ha, ha->sns_cmd_dma, RNN_ID_SNS_CMD_SIZE / 2,
1069             sizeof(struct sns_cmd_pkt));
1070         if (rval != QLA_SUCCESS) {
1071                 /*EMPTY*/
1072                 DEBUG2_3(printk("scsi(%ld): RNN_ID Send SNS failed (%d).\n",
1073                     ha->host_no, rval));
1074         } else if (sns_cmd->p.rnn_data[8] != 0x80 ||
1075             sns_cmd->p.rnn_data[9] != 0x02) {
1076                 DEBUG2_3(printk("scsi(%ld): RNN_ID failed, rejected request, "
1077                     "rnn_rsp:\n", ha->host_no));
1078                 DEBUG2_3(qla2x00_dump_buffer(sns_cmd->p.rnn_data, 16));
1079                 rval = QLA_FUNCTION_FAILED;
1080         } else {
1081                 DEBUG2(printk("scsi(%ld): RNN_ID exiting normally.\n",
1082                     ha->host_no));
1083         }
1084
1085         return (rval);
1086 }
1087
1088 /**
1089  * qla2x00_mgmt_svr_login() - Login to fabric Managment Service.
1090  * @ha: HA context
1091  *
1092  * Returns 0 on success.
1093  */
1094 static int
1095 qla2x00_mgmt_svr_login(scsi_qla_host_t *ha)
1096 {
1097         int ret;
1098         uint16_t mb[MAILBOX_REGISTER_COUNT];
1099
1100         ret = QLA_SUCCESS;
1101         if (ha->flags.management_server_logged_in)
1102                 return ret;
1103
1104         ha->isp_ops.fabric_login(ha, ha->mgmt_svr_loop_id, 0xff, 0xff, 0xfa,
1105             mb, BIT_1);
1106         if (mb[0] != MBS_COMMAND_COMPLETE) {
1107                 DEBUG2_13(printk("%s(%ld): Failed MANAGEMENT_SERVER login: "
1108                     "loop_id=%x mb[0]=%x mb[1]=%x mb[2]=%x mb[6]=%x mb[7]=%x\n",
1109                     __func__, ha->host_no, ha->mgmt_svr_loop_id, mb[0], mb[1],
1110                     mb[2], mb[6], mb[7]));
1111                 ret = QLA_FUNCTION_FAILED;
1112         } else
1113                 ha->flags.management_server_logged_in = 1;
1114
1115         return ret;
1116 }
1117
1118 /**
1119  * qla2x00_prep_ms_fdmi_iocb() - Prepare common MS IOCB fields for FDMI query.
1120  * @ha: HA context
1121  * @req_size: request size in bytes
1122  * @rsp_size: response size in bytes
1123  *
1124  * Returns a pointer to the @ha's ms_iocb.
1125  */
1126 void *
1127 qla2x00_prep_ms_fdmi_iocb(scsi_qla_host_t *ha, uint32_t req_size,
1128     uint32_t rsp_size)
1129 {
1130         ms_iocb_entry_t *ms_pkt;
1131
1132         ms_pkt = ha->ms_iocb;
1133         memset(ms_pkt, 0, sizeof(ms_iocb_entry_t));
1134
1135         ms_pkt->entry_type = MS_IOCB_TYPE;
1136         ms_pkt->entry_count = 1;
1137         SET_TARGET_ID(ha, ms_pkt->loop_id, ha->mgmt_svr_loop_id);
1138         ms_pkt->control_flags = __constant_cpu_to_le16(CF_READ | CF_HEAD_TAG);
1139         ms_pkt->timeout = __constant_cpu_to_le16(59);
1140         ms_pkt->cmd_dsd_count = __constant_cpu_to_le16(1);
1141         ms_pkt->total_dsd_count = __constant_cpu_to_le16(2);
1142         ms_pkt->rsp_bytecount = cpu_to_le32(rsp_size);
1143         ms_pkt->req_bytecount = cpu_to_le32(req_size);
1144
1145         ms_pkt->dseg_req_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1146         ms_pkt->dseg_req_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1147         ms_pkt->dseg_req_length = ms_pkt->req_bytecount;
1148
1149         ms_pkt->dseg_rsp_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1150         ms_pkt->dseg_rsp_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1151         ms_pkt->dseg_rsp_length = ms_pkt->rsp_bytecount;
1152
1153         return ms_pkt;
1154 }
1155
1156 /**
1157  * qla24xx_prep_ms_fdmi_iocb() - Prepare common MS IOCB fields for FDMI query.
1158  * @ha: HA context
1159  * @req_size: request size in bytes
1160  * @rsp_size: response size in bytes
1161  *
1162  * Returns a pointer to the @ha's ms_iocb.
1163  */
1164 void *
1165 qla24xx_prep_ms_fdmi_iocb(scsi_qla_host_t *ha, uint32_t req_size,
1166     uint32_t rsp_size)
1167 {
1168         struct ct_entry_24xx *ct_pkt;
1169
1170         ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
1171         memset(ct_pkt, 0, sizeof(struct ct_entry_24xx));
1172
1173         ct_pkt->entry_type = CT_IOCB_TYPE;
1174         ct_pkt->entry_count = 1;
1175         ct_pkt->nport_handle = cpu_to_le16(ha->mgmt_svr_loop_id);
1176         ct_pkt->timeout = __constant_cpu_to_le16(59);
1177         ct_pkt->cmd_dsd_count = __constant_cpu_to_le16(1);
1178         ct_pkt->rsp_dsd_count = __constant_cpu_to_le16(1);
1179         ct_pkt->rsp_byte_count = cpu_to_le32(rsp_size);
1180         ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
1181
1182         ct_pkt->dseg_0_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1183         ct_pkt->dseg_0_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1184         ct_pkt->dseg_0_len = ct_pkt->cmd_byte_count;
1185
1186         ct_pkt->dseg_1_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1187         ct_pkt->dseg_1_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1188         ct_pkt->dseg_1_len = ct_pkt->rsp_byte_count;
1189
1190         return ct_pkt;
1191 }
1192
1193 static inline ms_iocb_entry_t *
1194 qla2x00_update_ms_fdmi_iocb(scsi_qla_host_t *ha, uint32_t req_size)
1195 {
1196         ms_iocb_entry_t *ms_pkt = ha->ms_iocb;
1197         struct ct_entry_24xx *ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
1198
1199         if (IS_QLA24XX(ha) || IS_QLA54XX(ha)) {
1200                 ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
1201                 ct_pkt->dseg_0_len = ct_pkt->cmd_byte_count;
1202         } else {
1203                 ms_pkt->req_bytecount = cpu_to_le32(req_size);
1204                 ms_pkt->dseg_req_length = ms_pkt->req_bytecount;
1205         }
1206
1207         return ms_pkt;
1208 }
1209
1210 /**
1211  * qla2x00_prep_ct_req() - Prepare common CT request fields for SNS query.
1212  * @ct_req: CT request buffer
1213  * @cmd: GS command
1214  * @rsp_size: response size in bytes
1215  *
1216  * Returns a pointer to the intitialized @ct_req.
1217  */
1218 static inline struct ct_sns_req *
1219 qla2x00_prep_ct_fdmi_req(struct ct_sns_req *ct_req, uint16_t cmd,
1220     uint16_t rsp_size)
1221 {
1222         memset(ct_req, 0, sizeof(struct ct_sns_pkt));
1223
1224         ct_req->header.revision = 0x01;
1225         ct_req->header.gs_type = 0xFA;
1226         ct_req->header.gs_subtype = 0x10;
1227         ct_req->command = cpu_to_be16(cmd);
1228         ct_req->max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
1229
1230         return ct_req;
1231 }
1232
1233 /**
1234  * qla2x00_fdmi_rhba() -
1235  * @ha: HA context
1236  *
1237  * Returns 0 on success.
1238  */
1239 static int
1240 qla2x00_fdmi_rhba(scsi_qla_host_t *ha)
1241 {
1242         int rval, alen;
1243         uint32_t size, sn;
1244
1245         ms_iocb_entry_t *ms_pkt;
1246         struct ct_sns_req *ct_req;
1247         struct ct_sns_rsp *ct_rsp;
1248         uint8_t *entries;
1249         struct ct_fdmi_hba_attr *eiter;
1250
1251         /* Issue RHBA */
1252         /* Prepare common MS IOCB */
1253         /*   Request size adjusted after CT preparation */
1254         ms_pkt = ha->isp_ops.prep_ms_fdmi_iocb(ha, 0, RHBA_RSP_SIZE);
1255
1256         /* Prepare CT request */
1257         ct_req = qla2x00_prep_ct_fdmi_req(&ha->ct_sns->p.req, RHBA_CMD,
1258             RHBA_RSP_SIZE);
1259         ct_rsp = &ha->ct_sns->p.rsp;
1260
1261         /* Prepare FDMI command arguments -- attribute block, attributes. */
1262         memcpy(ct_req->req.rhba.hba_identifier, ha->port_name, WWN_SIZE);
1263         ct_req->req.rhba.entry_count = __constant_cpu_to_be32(1);
1264         memcpy(ct_req->req.rhba.port_name, ha->port_name, WWN_SIZE);
1265         size = 2 * WWN_SIZE + 4 + 4;
1266
1267         /* Attributes */
1268         ct_req->req.rhba.attrs.count =
1269             __constant_cpu_to_be32(FDMI_HBA_ATTR_COUNT);
1270         entries = ct_req->req.rhba.hba_identifier;
1271
1272         /* Nodename. */
1273         eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1274         eiter->type = __constant_cpu_to_be16(FDMI_HBA_NODE_NAME);
1275         eiter->len = __constant_cpu_to_be16(4 + WWN_SIZE);
1276         memcpy(eiter->a.node_name, ha->node_name, WWN_SIZE);
1277         size += 4 + WWN_SIZE;
1278
1279         DEBUG13(printk("%s(%ld): NODENAME=%02x%02x%02x%02x%02x%02x%02x%02x.\n",
1280             __func__, ha->host_no,
1281             eiter->a.node_name[0], eiter->a.node_name[1], eiter->a.node_name[2],
1282             eiter->a.node_name[3], eiter->a.node_name[4], eiter->a.node_name[5],
1283             eiter->a.node_name[6], eiter->a.node_name[7]));
1284
1285         /* Manufacturer. */
1286         eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1287         eiter->type = __constant_cpu_to_be16(FDMI_HBA_MANUFACTURER);
1288         strcpy(eiter->a.manufacturer, "QLogic Corporation");
1289         alen = strlen(eiter->a.manufacturer);
1290         alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1291         eiter->len = cpu_to_be16(4 + alen);
1292         size += 4 + alen;
1293
1294         DEBUG13(printk("%s(%ld): MANUFACTURER=%s.\n", __func__, ha->host_no,
1295             eiter->a.manufacturer));
1296
1297         /* Serial number. */
1298         eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1299         eiter->type = __constant_cpu_to_be16(FDMI_HBA_SERIAL_NUMBER);
1300         sn = ((ha->serial0 & 0x1f) << 16) | (ha->serial2 << 8) | ha->serial1;
1301         sprintf(eiter->a.serial_num, "%c%05d", 'A' + sn / 100000, sn % 100000);
1302         alen = strlen(eiter->a.serial_num);
1303         alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1304         eiter->len = cpu_to_be16(4 + alen);
1305         size += 4 + alen;
1306
1307         DEBUG13(printk("%s(%ld): SERIALNO=%s.\n", __func__, ha->host_no,
1308             eiter->a.serial_num));
1309
1310         /* Model name. */
1311         eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1312         eiter->type = __constant_cpu_to_be16(FDMI_HBA_MODEL);
1313         strcpy(eiter->a.model, ha->model_number);
1314         alen = strlen(eiter->a.model);
1315         alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1316         eiter->len = cpu_to_be16(4 + alen);
1317         size += 4 + alen;
1318
1319         DEBUG13(printk("%s(%ld): MODEL_NAME=%s.\n", __func__, ha->host_no,
1320             eiter->a.model));
1321
1322         /* Model description. */
1323         eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1324         eiter->type = __constant_cpu_to_be16(FDMI_HBA_MODEL_DESCRIPTION);
1325         if (ha->model_desc)
1326                 strncpy(eiter->a.model_desc, ha->model_desc, 80);
1327         alen = strlen(eiter->a.model_desc);
1328         alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1329         eiter->len = cpu_to_be16(4 + alen);
1330         size += 4 + alen;
1331
1332         DEBUG13(printk("%s(%ld): MODEL_DESC=%s.\n", __func__, ha->host_no,
1333             eiter->a.model_desc));
1334
1335         /* Hardware version. */
1336         eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1337         eiter->type = __constant_cpu_to_be16(FDMI_HBA_HARDWARE_VERSION);
1338         strcpy(eiter->a.hw_version, ha->adapter_id);
1339         alen = strlen(eiter->a.hw_version);
1340         alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1341         eiter->len = cpu_to_be16(4 + alen);
1342         size += 4 + alen;
1343
1344         DEBUG13(printk("%s(%ld): HARDWAREVER=%s.\n", __func__, ha->host_no,
1345             eiter->a.hw_version));
1346
1347         /* Driver version. */
1348         eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1349         eiter->type = __constant_cpu_to_be16(FDMI_HBA_DRIVER_VERSION);
1350         strcpy(eiter->a.driver_version, qla2x00_version_str);
1351         alen = strlen(eiter->a.driver_version);
1352         alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1353         eiter->len = cpu_to_be16(4 + alen);
1354         size += 4 + alen;
1355
1356         DEBUG13(printk("%s(%ld): DRIVERVER=%s.\n", __func__, ha->host_no,
1357             eiter->a.driver_version));
1358
1359         /* Option ROM version. */
1360         eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1361         eiter->type = __constant_cpu_to_be16(FDMI_HBA_OPTION_ROM_VERSION);
1362         strcpy(eiter->a.orom_version, "0.00");
1363         alen = strlen(eiter->a.orom_version);
1364         alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1365         eiter->len = cpu_to_be16(4 + alen);
1366         size += 4 + alen;
1367
1368         DEBUG13(printk("%s(%ld): OPTROMVER=%s.\n", __func__, ha->host_no,
1369             eiter->a.orom_version));
1370
1371         /* Firmware version */
1372         eiter = (struct ct_fdmi_hba_attr *) (entries + size);
1373         eiter->type = __constant_cpu_to_be16(FDMI_HBA_FIRMWARE_VERSION);
1374         ha->isp_ops.fw_version_str(ha, eiter->a.fw_version);
1375         alen = strlen(eiter->a.fw_version);
1376         alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1377         eiter->len = cpu_to_be16(4 + alen);
1378         size += 4 + alen;
1379
1380         DEBUG13(printk("%s(%ld): FIRMWAREVER=%s.\n", __func__, ha->host_no,
1381             eiter->a.fw_version));
1382
1383         /* Update MS request size. */
1384         qla2x00_update_ms_fdmi_iocb(ha, size + 16);
1385
1386         DEBUG13(printk("%s(%ld): RHBA identifier="
1387             "%02x%02x%02x%02x%02x%02x%02x%02x size=%d.\n", __func__,
1388             ha->host_no, ct_req->req.rhba.hba_identifier[0],
1389             ct_req->req.rhba.hba_identifier[1],
1390             ct_req->req.rhba.hba_identifier[2],
1391             ct_req->req.rhba.hba_identifier[3],
1392             ct_req->req.rhba.hba_identifier[4],
1393             ct_req->req.rhba.hba_identifier[5],
1394             ct_req->req.rhba.hba_identifier[6],
1395             ct_req->req.rhba.hba_identifier[7], size));
1396         DEBUG13(qla2x00_dump_buffer(entries, size));
1397
1398         /* Execute MS IOCB */
1399         rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
1400             sizeof(ms_iocb_entry_t));
1401         if (rval != QLA_SUCCESS) {
1402                 /*EMPTY*/
1403                 DEBUG2_3(printk("scsi(%ld): RHBA issue IOCB failed (%d).\n",
1404                     ha->host_no, rval));
1405         } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RHBA") !=
1406             QLA_SUCCESS) {
1407                 rval = QLA_FUNCTION_FAILED;
1408                 if (ct_rsp->header.reason_code == CT_REASON_CANNOT_PERFORM &&
1409                     ct_rsp->header.explanation_code ==
1410                     CT_EXPL_ALREADY_REGISTERED) {
1411                         DEBUG2_13(printk("%s(%ld): HBA already registered.\n",
1412                             __func__, ha->host_no));
1413                         rval = QLA_ALREADY_REGISTERED;
1414                 }
1415         } else {
1416                 DEBUG2(printk("scsi(%ld): RHBA exiting normally.\n",
1417                     ha->host_no));
1418         }
1419
1420         return rval;
1421 }
1422
1423 /**
1424  * qla2x00_fdmi_dhba() -
1425  * @ha: HA context
1426  *
1427  * Returns 0 on success.
1428  */
1429 static int
1430 qla2x00_fdmi_dhba(scsi_qla_host_t *ha)
1431 {
1432         int rval;
1433
1434         ms_iocb_entry_t *ms_pkt;
1435         struct ct_sns_req *ct_req;
1436         struct ct_sns_rsp *ct_rsp;
1437
1438         /* Issue RPA */
1439         /* Prepare common MS IOCB */
1440         ms_pkt = ha->isp_ops.prep_ms_fdmi_iocb(ha, DHBA_REQ_SIZE,
1441             DHBA_RSP_SIZE);
1442
1443         /* Prepare CT request */
1444         ct_req = qla2x00_prep_ct_fdmi_req(&ha->ct_sns->p.req, DHBA_CMD,
1445             DHBA_RSP_SIZE);
1446         ct_rsp = &ha->ct_sns->p.rsp;
1447
1448         /* Prepare FDMI command arguments -- portname. */
1449         memcpy(ct_req->req.dhba.port_name, ha->port_name, WWN_SIZE);
1450
1451         DEBUG13(printk("%s(%ld): DHBA portname="
1452             "%02x%02x%02x%02x%02x%02x%02x%02x.\n", __func__, ha->host_no,
1453             ct_req->req.dhba.port_name[0], ct_req->req.dhba.port_name[1],
1454             ct_req->req.dhba.port_name[2], ct_req->req.dhba.port_name[3],
1455             ct_req->req.dhba.port_name[4], ct_req->req.dhba.port_name[5],
1456             ct_req->req.dhba.port_name[6], ct_req->req.dhba.port_name[7]));
1457
1458         /* Execute MS IOCB */
1459         rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
1460             sizeof(ms_iocb_entry_t));
1461         if (rval != QLA_SUCCESS) {
1462                 /*EMPTY*/
1463                 DEBUG2_3(printk("scsi(%ld): DHBA issue IOCB failed (%d).\n",
1464                     ha->host_no, rval));
1465         } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "DHBA") !=
1466             QLA_SUCCESS) {
1467                 rval = QLA_FUNCTION_FAILED;
1468         } else {
1469                 DEBUG2(printk("scsi(%ld): DHBA exiting normally.\n",
1470                     ha->host_no));
1471         }
1472
1473         return rval;
1474 }
1475
1476 /**
1477  * qla2x00_fdmi_rpa() -
1478  * @ha: HA context
1479  *
1480  * Returns 0 on success.
1481  */
1482 static int
1483 qla2x00_fdmi_rpa(scsi_qla_host_t *ha)
1484 {
1485         int rval, alen;
1486         uint32_t size, max_frame_size;
1487
1488         ms_iocb_entry_t *ms_pkt;
1489         struct ct_sns_req *ct_req;
1490         struct ct_sns_rsp *ct_rsp;
1491         uint8_t *entries;
1492         struct ct_fdmi_port_attr *eiter;
1493         struct init_cb_24xx *icb24 = (struct init_cb_24xx *)ha->init_cb;
1494
1495         /* Issue RPA */
1496         /* Prepare common MS IOCB */
1497         /*   Request size adjusted after CT preparation */
1498         ms_pkt = ha->isp_ops.prep_ms_fdmi_iocb(ha, 0, RPA_RSP_SIZE);
1499
1500         /* Prepare CT request */
1501         ct_req = qla2x00_prep_ct_fdmi_req(&ha->ct_sns->p.req, RPA_CMD,
1502             RPA_RSP_SIZE);
1503         ct_rsp = &ha->ct_sns->p.rsp;
1504
1505         /* Prepare FDMI command arguments -- attribute block, attributes. */
1506         memcpy(ct_req->req.rpa.port_name, ha->port_name, WWN_SIZE);
1507         size = WWN_SIZE + 4;
1508
1509         /* Attributes */
1510         ct_req->req.rpa.attrs.count =
1511             __constant_cpu_to_be32(FDMI_PORT_ATTR_COUNT);
1512         entries = ct_req->req.rpa.port_name;
1513
1514         /* FC4 types. */
1515         eiter = (struct ct_fdmi_port_attr *) (entries + size);
1516         eiter->type = __constant_cpu_to_be16(FDMI_PORT_FC4_TYPES);
1517         eiter->len = __constant_cpu_to_be16(4 + 32);
1518         eiter->a.fc4_types[2] = 0x01;
1519         size += 4 + 32;
1520
1521         DEBUG13(printk("%s(%ld): FC4_TYPES=%02x %02x.\n", __func__, ha->host_no,
1522             eiter->a.fc4_types[2], eiter->a.fc4_types[1]));
1523
1524         /* Supported speed. */
1525         eiter = (struct ct_fdmi_port_attr *) (entries + size);
1526         eiter->type = __constant_cpu_to_be16(FDMI_PORT_SUPPORT_SPEED);
1527         eiter->len = __constant_cpu_to_be16(4 + 4);
1528         if (IS_QLA24XX(ha) || IS_QLA54XX(ha))
1529                 eiter->a.sup_speed = __constant_cpu_to_be32(4);
1530         else if (IS_QLA23XX(ha))
1531                 eiter->a.sup_speed = __constant_cpu_to_be32(2);
1532         else
1533                 eiter->a.sup_speed = __constant_cpu_to_be32(1);
1534         size += 4 + 4;
1535
1536         DEBUG13(printk("%s(%ld): SUPPORTED_SPEED=%x.\n", __func__, ha->host_no,
1537             eiter->a.sup_speed));
1538
1539         /* Current speed. */
1540         eiter = (struct ct_fdmi_port_attr *) (entries + size);
1541         eiter->type = __constant_cpu_to_be16(FDMI_PORT_CURRENT_SPEED);
1542         eiter->len = __constant_cpu_to_be16(4 + 4);
1543         switch (ha->link_data_rate) {
1544         case 0:
1545                 eiter->a.cur_speed = __constant_cpu_to_be32(1);
1546                 break;
1547         case 1:
1548                 eiter->a.cur_speed = __constant_cpu_to_be32(2);
1549                 break;
1550         case 3:
1551                 eiter->a.cur_speed = __constant_cpu_to_be32(4);
1552                 break;
1553         }
1554         size += 4 + 4;
1555
1556         DEBUG13(printk("%s(%ld): CURRENT_SPEED=%x.\n", __func__, ha->host_no,
1557             eiter->a.cur_speed));
1558
1559         /* Max frame size. */
1560         eiter = (struct ct_fdmi_port_attr *) (entries + size);
1561         eiter->type = __constant_cpu_to_be16(FDMI_PORT_MAX_FRAME_SIZE);
1562         eiter->len = __constant_cpu_to_be16(4 + 4);
1563         max_frame_size = IS_QLA24XX(ha) || IS_QLA54XX(ha) ?
1564                 (uint32_t) icb24->frame_payload_size:
1565                 (uint32_t) ha->init_cb->frame_payload_size;
1566         eiter->a.max_frame_size = cpu_to_be32(max_frame_size);
1567         size += 4 + 4;
1568
1569         DEBUG13(printk("%s(%ld): MAX_FRAME_SIZE=%x.\n", __func__, ha->host_no,
1570             eiter->a.max_frame_size));
1571
1572         /* OS device name. */
1573         eiter = (struct ct_fdmi_port_attr *) (entries + size);
1574         eiter->type = __constant_cpu_to_be16(FDMI_PORT_OS_DEVICE_NAME);
1575         sprintf(eiter->a.os_dev_name, "/proc/scsi/qla2xxx/%ld", ha->host_no);
1576         alen = strlen(eiter->a.os_dev_name);
1577         alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1578         eiter->len = cpu_to_be16(4 + alen);
1579         size += 4 + alen;
1580
1581         DEBUG13(printk("%s(%ld): OS_DEVICE_NAME=%s.\n", __func__, ha->host_no,
1582             eiter->a.os_dev_name));
1583
1584         /* Hostname. */
1585         if (strlen(fc_host_system_hostname(ha->host))) {
1586                 eiter = (struct ct_fdmi_port_attr *) (entries + size);
1587                 eiter->type = __constant_cpu_to_be16(FDMI_PORT_HOST_NAME);
1588                 snprintf(eiter->a.host_name, sizeof(eiter->a.host_name),
1589                     "%s", fc_host_system_hostname(ha->host));
1590                 alen = strlen(eiter->a.host_name);
1591                 alen += (alen & 3) ? (4 - (alen & 3)) : 4;
1592                 eiter->len = cpu_to_be16(4 + alen);
1593                 size += 4 + alen;
1594
1595                 DEBUG13(printk("%s(%ld): HOSTNAME=%s.\n", __func__,
1596                     ha->host_no, eiter->a.host_name));
1597         }
1598
1599         /* Update MS request size. */
1600         qla2x00_update_ms_fdmi_iocb(ha, size + 16);
1601
1602         DEBUG13(printk("%s(%ld): RPA portname="
1603             "%02x%02x%02x%02x%02x%02x%02x%02x size=%d.\n", __func__,
1604             ha->host_no, ct_req->req.rpa.port_name[0],
1605             ct_req->req.rpa.port_name[1], ct_req->req.rpa.port_name[2],
1606             ct_req->req.rpa.port_name[3], ct_req->req.rpa.port_name[4],
1607             ct_req->req.rpa.port_name[5], ct_req->req.rpa.port_name[6],
1608             ct_req->req.rpa.port_name[7], size));
1609         DEBUG13(qla2x00_dump_buffer(entries, size));
1610
1611         /* Execute MS IOCB */
1612         rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
1613             sizeof(ms_iocb_entry_t));
1614         if (rval != QLA_SUCCESS) {
1615                 /*EMPTY*/
1616                 DEBUG2_3(printk("scsi(%ld): RPA issue IOCB failed (%d).\n",
1617                     ha->host_no, rval));
1618         } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp, "RPA") !=
1619             QLA_SUCCESS) {
1620                 rval = QLA_FUNCTION_FAILED;
1621         } else {
1622                 DEBUG2(printk("scsi(%ld): RPA exiting normally.\n",
1623                     ha->host_no));
1624         }
1625
1626         return rval;
1627 }
1628
1629 /**
1630  * qla2x00_fdmi_register() -
1631  * @ha: HA context
1632  *
1633  * Returns 0 on success.
1634  */
1635 int
1636 qla2x00_fdmi_register(scsi_qla_host_t *ha)
1637 {
1638         int rval;
1639
1640         rval = qla2x00_mgmt_svr_login(ha);
1641         if (rval)
1642                 return rval;
1643
1644         rval = qla2x00_fdmi_rhba(ha);
1645         if (rval) {
1646                 if (rval != QLA_ALREADY_REGISTERED)
1647                         return rval;
1648
1649                 rval = qla2x00_fdmi_dhba(ha);
1650                 if (rval)
1651                         return rval;
1652
1653                 rval = qla2x00_fdmi_rhba(ha);
1654                 if (rval)
1655                         return rval;
1656         }
1657         rval = qla2x00_fdmi_rpa(ha);
1658
1659         return rval;
1660 }
1661
1662 /**
1663  * qla2x00_gfpn_id() - SNS Get Fabric Port Name (GFPN_ID) query.
1664  * @ha: HA context
1665  * @list: switch info entries to populate
1666  *
1667  * Returns 0 on success.
1668  */
1669 int
1670 qla2x00_gfpn_id(scsi_qla_host_t *ha, sw_info_t *list)
1671 {
1672         int             rval;
1673         uint16_t        i;
1674
1675         ms_iocb_entry_t *ms_pkt;
1676         struct ct_sns_req       *ct_req;
1677         struct ct_sns_rsp       *ct_rsp;
1678
1679         if (!IS_QLA24XX(ha) && !IS_QLA54XX(ha))
1680                 return QLA_FUNCTION_FAILED;
1681
1682         for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
1683                 /* Issue GFPN_ID */
1684                 memset(list[i].fabric_port_name, 0, WWN_SIZE);
1685
1686                 /* Prepare common MS IOCB */
1687                 ms_pkt = ha->isp_ops.prep_ms_iocb(ha, GFPN_ID_REQ_SIZE,
1688                     GFPN_ID_RSP_SIZE);
1689
1690                 /* Prepare CT request */
1691                 ct_req = qla2x00_prep_ct_req(&ha->ct_sns->p.req, GFPN_ID_CMD,
1692                     GFPN_ID_RSP_SIZE);
1693                 ct_rsp = &ha->ct_sns->p.rsp;
1694
1695                 /* Prepare CT arguments -- port_id */
1696                 ct_req->req.port_id.port_id[0] = list[i].d_id.b.domain;
1697                 ct_req->req.port_id.port_id[1] = list[i].d_id.b.area;
1698                 ct_req->req.port_id.port_id[2] = list[i].d_id.b.al_pa;
1699
1700                 /* Execute MS IOCB */
1701                 rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
1702                     sizeof(ms_iocb_entry_t));
1703                 if (rval != QLA_SUCCESS) {
1704                         /*EMPTY*/
1705                         DEBUG2_3(printk("scsi(%ld): GFPN_ID issue IOCB "
1706                             "failed (%d).\n", ha->host_no, rval));
1707                 } else if (qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp,
1708                     "GFPN_ID") != QLA_SUCCESS) {
1709                         rval = QLA_FUNCTION_FAILED;
1710                 } else {
1711                         /* Save fabric portname */
1712                         memcpy(list[i].fabric_port_name,
1713                             ct_rsp->rsp.gfpn_id.port_name, WWN_SIZE);
1714                 }
1715
1716                 /* Last device exit. */
1717                 if (list[i].d_id.b.rsvd_1 != 0)
1718                         break;
1719         }
1720
1721         return (rval);
1722 }
1723
1724 static inline void *
1725 qla24xx_prep_ms_fm_iocb(scsi_qla_host_t *ha, uint32_t req_size,
1726     uint32_t rsp_size)
1727 {
1728         struct ct_entry_24xx *ct_pkt;
1729
1730         ct_pkt = (struct ct_entry_24xx *)ha->ms_iocb;
1731         memset(ct_pkt, 0, sizeof(struct ct_entry_24xx));
1732
1733         ct_pkt->entry_type = CT_IOCB_TYPE;
1734         ct_pkt->entry_count = 1;
1735         ct_pkt->nport_handle = cpu_to_le16(ha->mgmt_svr_loop_id);
1736         ct_pkt->timeout = __constant_cpu_to_le16(59);
1737         ct_pkt->cmd_dsd_count = __constant_cpu_to_le16(1);
1738         ct_pkt->rsp_dsd_count = __constant_cpu_to_le16(1);
1739         ct_pkt->rsp_byte_count = cpu_to_le32(rsp_size);
1740         ct_pkt->cmd_byte_count = cpu_to_le32(req_size);
1741
1742         ct_pkt->dseg_0_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1743         ct_pkt->dseg_0_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1744         ct_pkt->dseg_0_len = ct_pkt->cmd_byte_count;
1745
1746         ct_pkt->dseg_1_address[0] = cpu_to_le32(LSD(ha->ct_sns_dma));
1747         ct_pkt->dseg_1_address[1] = cpu_to_le32(MSD(ha->ct_sns_dma));
1748         ct_pkt->dseg_1_len = ct_pkt->rsp_byte_count;
1749
1750         return ct_pkt;
1751 }
1752
1753
1754 static inline struct ct_sns_req *
1755 qla24xx_prep_ct_fm_req(struct ct_sns_req *ct_req, uint16_t cmd,
1756     uint16_t rsp_size)
1757 {
1758         memset(ct_req, 0, sizeof(struct ct_sns_pkt));
1759
1760         ct_req->header.revision = 0x01;
1761         ct_req->header.gs_type = 0xFA;
1762         ct_req->header.gs_subtype = 0x01;
1763         ct_req->command = cpu_to_be16(cmd);
1764         ct_req->max_rsp_size = cpu_to_be16((rsp_size - 16) / 4);
1765
1766         return ct_req;
1767 }
1768
1769 /**
1770  * qla2x00_gpsc() - FCS Get Port Speed Capabilities (GPSC) query.
1771  * @ha: HA context
1772  * @list: switch info entries to populate
1773  *
1774  * Returns 0 on success.
1775  */
1776 int
1777 qla2x00_gpsc(scsi_qla_host_t *ha, sw_info_t *list)
1778 {
1779         int             rval;
1780         uint16_t        i;
1781
1782         ms_iocb_entry_t *ms_pkt;
1783         struct ct_sns_req       *ct_req;
1784         struct ct_sns_rsp       *ct_rsp;
1785
1786         if (!IS_QLA24XX(ha) && !IS_QLA54XX(ha))
1787                 return QLA_FUNCTION_FAILED;
1788         if (!ha->flags.gpsc_supported)
1789                 return QLA_FUNCTION_FAILED;
1790
1791         rval = qla2x00_mgmt_svr_login(ha);
1792         if (rval)
1793                 return rval;
1794
1795         for (i = 0; i < MAX_FIBRE_DEVICES; i++) {
1796                 /* Issue GFPN_ID */
1797                 list[i].fp_speeds = list[i].fp_speed = 0;
1798
1799                 /* Prepare common MS IOCB */
1800                 ms_pkt = qla24xx_prep_ms_fm_iocb(ha, GPSC_REQ_SIZE,
1801                     GPSC_RSP_SIZE);
1802
1803                 /* Prepare CT request */
1804                 ct_req = qla24xx_prep_ct_fm_req(&ha->ct_sns->p.req,
1805                     GPSC_CMD, GPSC_RSP_SIZE);
1806                 ct_rsp = &ha->ct_sns->p.rsp;
1807
1808                 /* Prepare CT arguments -- port_name */
1809                 memcpy(ct_req->req.gpsc.port_name, list[i].fabric_port_name,
1810                     WWN_SIZE);
1811
1812                 /* Execute MS IOCB */
1813                 rval = qla2x00_issue_iocb(ha, ha->ms_iocb, ha->ms_iocb_dma,
1814                     sizeof(ms_iocb_entry_t));
1815                 if (rval != QLA_SUCCESS) {
1816                         /*EMPTY*/
1817                         DEBUG2_3(printk("scsi(%ld): GPSC issue IOCB "
1818                             "failed (%d).\n", ha->host_no, rval));
1819                 } else if ((rval = qla2x00_chk_ms_status(ha, ms_pkt, ct_rsp,
1820                     "GPSC")) != QLA_SUCCESS) {
1821                         /* FM command unsupported? */
1822                         if (rval == QLA_INVALID_COMMAND &&
1823                             ct_rsp->header.reason_code ==
1824                             CT_REASON_INVALID_COMMAND_CODE) {
1825                                 DEBUG2(printk("scsi(%ld): GPSC command "
1826                                     "unsupported, disabling query...\n",
1827                                     ha->host_no));
1828                                 ha->flags.gpsc_supported = 0;
1829                                 rval = QLA_FUNCTION_FAILED;
1830                                 break;
1831                         }
1832                         rval = QLA_FUNCTION_FAILED;
1833                 } else {
1834                         /* Save portname */
1835                         list[i].fp_speeds = ct_rsp->rsp.gpsc.speeds;
1836                         list[i].fp_speed = ct_rsp->rsp.gpsc.speed;
1837
1838                         DEBUG2_3(printk("scsi(%ld): GPSC ext entry - "
1839                             "fpn %02x%02x%02x%02x%02x%02x%02x%02x speeds=%04x "
1840                             "speed=%04x.\n", ha->host_no,
1841                             list[i].fabric_port_name[0],
1842                             list[i].fabric_port_name[1],
1843                             list[i].fabric_port_name[2],
1844                             list[i].fabric_port_name[3],
1845                             list[i].fabric_port_name[4],
1846                             list[i].fabric_port_name[5],
1847                             list[i].fabric_port_name[6],
1848                             list[i].fabric_port_name[7],
1849                             be16_to_cpu(list[i].fp_speeds),
1850                             be16_to_cpu(list[i].fp_speed)));
1851                 }
1852
1853                 /* Last device exit. */
1854                 if (list[i].d_id.b.rsvd_1 != 0)
1855                         break;
1856         }
1857
1858         return (rval);
1859 }