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