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

   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
   9 #include <linux/delay.h>
  10
  11
  12 /*
  13  * qla2x00_mailbox_command
  14  *      Issue mailbox command and waits for completion.
  15  *
  16  * Input:
  17  *      ha = adapter block pointer.
  18  *      mcp = driver internal mbx struct pointer.
  19  *
  20  * Output:
  21  *      mb[MAX_MAILBOX_REGISTER_COUNT] = returned mailbox data.
  22  *
  23  * Returns:
  24  *      0 : QLA_SUCCESS = cmd performed success
  25  *      1 : QLA_FUNCTION_FAILED   (error encountered)
  26  *      6 : QLA_FUNCTION_TIMEOUT (timeout condition encountered)
  27  *
  28  * Context:
  29  *      Kernel context.
  30  */
  31 static int
  32 qla2x00_mailbox_command(scsi_qla_host_t *vha, mbx_cmd_t *mcp)
  33 {
  34         int             rval;
  35         unsigned long    flags = 0;
  36         device_reg_t __iomem *reg;
  37         uint8_t         abort_active;
  38         uint8_t         io_lock_on;
  39         uint16_t        command;
  40         uint16_t        *iptr;
  41         uint16_t __iomem *optr;
  42         uint32_t        cnt;
  43         uint32_t        mboxes;
  44         unsigned long   wait_time;
  45         struct qla_hw_data *ha = vha->hw;
  46         scsi_qla_host_t *base_vha = pci_get_drvdata(ha->pdev);
  47
  48         if (ha->pdev->error_state > pci_channel_io_frozen)
  49                 return QLA_FUNCTION_TIMEOUT;
  50
  51         reg = ha->iobase;
  52         io_lock_on = base_vha->flags.init_done;
  53
  54         rval = QLA_SUCCESS;
  55         abort_active = test_bit(ABORT_ISP_ACTIVE, &base_vha->dpc_flags);
  56
  57         DEBUG11(printk("%s(%ld): entered.\n", __func__, base_vha->host_no));
  58
  59         /*
  60          * Wait for active mailbox commands to finish by waiting at most tov
  61          * seconds. This is to serialize actual issuing of mailbox cmds during
  62          * non ISP abort time.
  63          */
  64         if (!wait_for_completion_timeout(&ha->mbx_cmd_comp, mcp->tov * HZ)) {
  65                 /* Timeout occurred. Return error. */
  66                 DEBUG2_3_11(printk("%s(%ld): cmd access timeout. "
  67                     "Exiting.\n", __func__, base_vha->host_no));
  68                 return QLA_FUNCTION_TIMEOUT;
  69         }
  70
  71         ha->flags.mbox_busy = 1;
  72         /* Save mailbox command for debug */
  73         ha->mcp = mcp;
  74
  75         DEBUG11(printk("scsi(%ld): prepare to issue mbox cmd=0x%x.\n",
  76             base_vha->host_no, mcp->mb[0]));
  77
  78         spin_lock_irqsave(&ha->hardware_lock, flags);
  79
  80         /* Load mailbox registers. */
  81         if (IS_FWI2_CAPABLE(ha))
  82                 optr = (uint16_t __iomem *)&reg->isp24.mailbox0;
  83         else
  84                 optr = (uint16_t __iomem *)MAILBOX_REG(ha, &reg->isp, 0);
  85
  86         iptr = mcp->mb;
  87         command = mcp->mb[0];
  88         mboxes = mcp->out_mb;
  89
  90         for (cnt = 0; cnt < ha->mbx_count; cnt++) {
  91                 if (IS_QLA2200(ha) && cnt == 8)
  92                         optr =
  93                             (uint16_t __iomem *)MAILBOX_REG(ha, &reg->isp, 8);
  94                 if (mboxes & BIT_0)
  95                         WRT_REG_WORD(optr, *iptr);
  96
  97                 mboxes >>= 1;
  98                 optr++;
  99                 iptr++;
 100         }
 101
 102 #if defined(QL_DEBUG_LEVEL_1)
 103         printk("%s(%ld): Loaded MBX registers (displayed in bytes) = \n",
 104             __func__, base_vha->host_no);
 105         qla2x00_dump_buffer((uint8_t *)mcp->mb, 16);
 106         printk("\n");
 107         qla2x00_dump_buffer(((uint8_t *)mcp->mb + 0x10), 16);
 108         printk("\n");
 109         qla2x00_dump_buffer(((uint8_t *)mcp->mb + 0x20), 8);
 110         printk("\n");
 111         printk("%s(%ld): I/O address = %p.\n", __func__, base_vha->host_no,
 112                 optr);
 113         qla2x00_dump_regs(base_vha);
 114 #endif
 115
 116         /* Issue set host interrupt command to send cmd out. */
 117         ha->flags.mbox_int = 0;
 118         clear_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
 119
 120         /* Unlock mbx registers and wait for interrupt */
 121         DEBUG11(printk("%s(%ld): going to unlock irq & waiting for interrupt. "
 122             "jiffies=%lx.\n", __func__, base_vha->host_no, jiffies));
 123
 124         /* Wait for mbx cmd completion until timeout */
 125
 126         if ((!abort_active && io_lock_on) || IS_NOPOLLING_TYPE(ha)) {
 127                 set_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags);
 128
 129                 if (IS_FWI2_CAPABLE(ha))
 130                         WRT_REG_DWORD(&reg->isp24.hccr, HCCRX_SET_HOST_INT);
 131                 else
 132                         WRT_REG_WORD(&reg->isp.hccr, HCCR_SET_HOST_INT);
 133                 spin_unlock_irqrestore(&ha->hardware_lock, flags);
 134
 135                 wait_for_completion_timeout(&ha->mbx_intr_comp, mcp->tov * HZ);
 136
 137                 clear_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags);
 138
 139         } else {
 140                 DEBUG3_11(printk("%s(%ld): cmd=%x POLLING MODE.\n", __func__,
 141                     base_vha->host_no, command));
 142
 143                 if (IS_FWI2_CAPABLE(ha))
 144                         WRT_REG_DWORD(&reg->isp24.hccr, HCCRX_SET_HOST_INT);
 145                 else
 146                         WRT_REG_WORD(&reg->isp.hccr, HCCR_SET_HOST_INT);
 147                 spin_unlock_irqrestore(&ha->hardware_lock, flags);
 148
 149                 wait_time = jiffies + mcp->tov * HZ; /* wait at most tov secs */
 150                 while (!ha->flags.mbox_int) {
 151                         if (time_after(jiffies, wait_time))
 152                                 break;
 153
 154                         /* Check for pending interrupts. */
 155                         qla2x00_poll(ha->rsp_q_map[0]);
 156
 157                         if (command != MBC_LOAD_RISC_RAM_EXTENDED &&
 158                             !ha->flags.mbox_int)
 159                                 msleep(10);
 160                 } /* while */
 161         }
 162
 163         /* Check whether we timed out */
 164         if (ha->flags.mbox_int) {
 165                 uint16_t *iptr2;
 166
 167                 DEBUG3_11(printk("%s(%ld): cmd %x completed.\n", __func__,
 168                     base_vha->host_no, command));
 169
 170                 /* Got interrupt. Clear the flag. */
 171                 ha->flags.mbox_int = 0;
 172                 clear_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
 173
 174                 if (ha->mailbox_out[0] != MBS_COMMAND_COMPLETE)
 175                         rval = QLA_FUNCTION_FAILED;
 176
 177                 /* Load return mailbox registers. */
 178                 iptr2 = mcp->mb;
 179                 iptr = (uint16_t *)&ha->mailbox_out[0];
 180                 mboxes = mcp->in_mb;
 181                 for (cnt = 0; cnt < ha->mbx_count; cnt++) {
 182                         if (mboxes & BIT_0)
 183                                 *iptr2 = *iptr;
 184
 185                         mboxes >>= 1;
 186                         iptr2++;
 187                         iptr++;
 188                 }
 189         } else {
 190
 191 #if defined(QL_DEBUG_LEVEL_2) || defined(QL_DEBUG_LEVEL_3) || \
 192                 defined(QL_DEBUG_LEVEL_11)
 193                 uint16_t mb0;
 194                 uint32_t ictrl;
 195
 196                 if (IS_FWI2_CAPABLE(ha)) {
 197                         mb0 = RD_REG_WORD(&reg->isp24.mailbox0);
 198                         ictrl = RD_REG_DWORD(&reg->isp24.ictrl);
 199                 } else {
 200                         mb0 = RD_MAILBOX_REG(ha, &reg->isp, 0);
 201                         ictrl = RD_REG_WORD(&reg->isp.ictrl);
 202                 }
 203                 printk("%s(%ld): **** MB Command Timeout for cmd %x ****\n",
 204                     __func__, base_vha->host_no, command);
 205                 printk("%s(%ld): icontrol=%x jiffies=%lx\n", __func__,
 206                     base_vha->host_no, ictrl, jiffies);
 207                 printk("%s(%ld): *** mailbox[0] = 0x%x ***\n", __func__,
 208                     base_vha->host_no, mb0);
 209                 qla2x00_dump_regs(base_vha);
 210 #endif
 211
 212                 rval = QLA_FUNCTION_TIMEOUT;
 213         }
 214
 215         ha->flags.mbox_busy = 0;
 216
 217         /* Clean up */
 218         ha->mcp = NULL;
 219
 220         if ((abort_active || !io_lock_on) && !IS_NOPOLLING_TYPE(ha)) {
 221                 DEBUG11(printk("%s(%ld): checking for additional resp "
 222                     "interrupt.\n", __func__, base_vha->host_no));
 223
 224                 /* polling mode for non isp_abort commands. */
 225                 qla2x00_poll(ha->rsp_q_map[0]);
 226         }
 227
 228         if (rval == QLA_FUNCTION_TIMEOUT &&
 229             mcp->mb[0] != MBC_GEN_SYSTEM_ERROR) {
 230                 if (!io_lock_on || (mcp->flags & IOCTL_CMD)) {
 231                         /* not in dpc. schedule it for dpc to take over. */
 232                         DEBUG(printk("%s(%ld): timeout schedule "
 233                         "isp_abort_needed.\n", __func__,
 234                         base_vha->host_no));
 235                         DEBUG2_3_11(printk("%s(%ld): timeout schedule "
 236                         "isp_abort_needed.\n", __func__,
 237                         base_vha->host_no));
 238                         qla_printk(KERN_WARNING, ha,
 239                             "Mailbox command timeout occurred. Scheduling ISP "
 240                             "abort.\n");
 241                         set_bit(ISP_ABORT_NEEDED, &base_vha->dpc_flags);
 242                         qla2xxx_wake_dpc(vha);
 243                 } else if (!abort_active) {
 244                         /* call abort directly since we are in the DPC thread */
 245                         DEBUG(printk("%s(%ld): timeout calling abort_isp\n",
 246                             __func__, base_vha->host_no));
 247                         DEBUG2_3_11(printk("%s(%ld): timeout calling "
 248                             "abort_isp\n", __func__, base_vha->host_no));
 249                         qla_printk(KERN_WARNING, ha,
 250                             "Mailbox command timeout occurred. Issuing ISP "
 251                             "abort.\n");
 252
 253                         set_bit(ABORT_ISP_ACTIVE, &base_vha->dpc_flags);
 254                         clear_bit(ISP_ABORT_NEEDED, &base_vha->dpc_flags);
 255                         if (qla2x00_abort_isp(base_vha)) {
 256                                 /* Failed. retry later. */
 257                                 set_bit(ISP_ABORT_NEEDED, &base_vha->dpc_flags);
 258                         }
 259                         clear_bit(ABORT_ISP_ACTIVE, &base_vha->dpc_flags);
 260                         DEBUG(printk("%s(%ld): finished abort_isp\n", __func__,
 261                             base_vha->host_no));
 262                         DEBUG2_3_11(printk("%s(%ld): finished abort_isp\n",
 263                             __func__, base_vha->host_no));
 264                 }
 265         }
 266
 267         /* Allow next mbx cmd to come in. */
 268         complete(&ha->mbx_cmd_comp);
 269
 270         if (rval) {
 271                 DEBUG2_3_11(printk("%s(%ld): **** FAILED. mbx0=%x, mbx1=%x, "
 272                     "mbx2=%x, cmd=%x ****\n", __func__, base_vha->host_no,
 273                     mcp->mb[0], mcp->mb[1], mcp->mb[2], command));
 274         } else {
 275                 DEBUG11(printk("%s(%ld): done.\n", __func__,
 276                 base_vha->host_no));
 277         }
 278
 279         return rval;
 280 }
 281
 282 int
 283 qla2x00_load_ram(scsi_qla_host_t *vha, dma_addr_t req_dma, uint32_t risc_addr,
 284     uint32_t risc_code_size)
 285 {
 286         int rval;
 287         struct qla_hw_data *ha = vha->hw;
 288         mbx_cmd_t mc;
 289         mbx_cmd_t *mcp = &mc;
 290
 291         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
 292
 293         if (MSW(risc_addr) || IS_FWI2_CAPABLE(ha)) {
 294                 mcp->mb[0] = MBC_LOAD_RISC_RAM_EXTENDED;
 295                 mcp->mb[8] = MSW(risc_addr);
 296                 mcp->out_mb = MBX_8|MBX_0;
 297         } else {
 298                 mcp->mb[0] = MBC_LOAD_RISC_RAM;
 299                 mcp->out_mb = MBX_0;
 300         }
 301         mcp->mb[1] = LSW(risc_addr);
 302         mcp->mb[2] = MSW(req_dma);
 303         mcp->mb[3] = LSW(req_dma);
 304         mcp->mb[6] = MSW(MSD(req_dma));
 305         mcp->mb[7] = LSW(MSD(req_dma));
 306         mcp->out_mb |= MBX_7|MBX_6|MBX_3|MBX_2|MBX_1;
 307         if (IS_FWI2_CAPABLE(ha)) {
 308                 mcp->mb[4] = MSW(risc_code_size);
 309                 mcp->mb[5] = LSW(risc_code_size);
 310                 mcp->out_mb |= MBX_5|MBX_4;
 311         } else {
 312                 mcp->mb[4] = LSW(risc_code_size);
 313                 mcp->out_mb |= MBX_4;
 314         }
 315
 316         mcp->in_mb = MBX_0;
 317         mcp->tov = MBX_TOV_SECONDS;
 318         mcp->flags = 0;
 319         rval = qla2x00_mailbox_command(vha, mcp);
 320
 321         if (rval != QLA_SUCCESS) {
 322                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x.\n", __func__,
 323                     vha->host_no, rval, mcp->mb[0]));
 324         } else {
 325                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
 326         }
 327
 328         return rval;
 329 }
 330
 331 /*
 332  * qla2x00_execute_fw
 333  *     Start adapter firmware.
 334  *
 335  * Input:
 336  *     ha = adapter block pointer.
 337  *     TARGET_QUEUE_LOCK must be released.
 338  *     ADAPTER_STATE_LOCK must be released.
 339  *
 340  * Returns:
 341  *     qla2x00 local function return status code.
 342  *
 343  * Context:
 344  *     Kernel context.
 345  */
 346 int
 347 qla2x00_execute_fw(scsi_qla_host_t *vha, uint32_t risc_addr)
 348 {
 349         int rval;
 350         struct qla_hw_data *ha = vha->hw;
 351         mbx_cmd_t mc;
 352         mbx_cmd_t *mcp = &mc;
 353
 354         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
 355
 356         mcp->mb[0] = MBC_EXECUTE_FIRMWARE;
 357         mcp->out_mb = MBX_0;
 358         mcp->in_mb = MBX_0;
 359         if (IS_FWI2_CAPABLE(ha)) {
 360                 mcp->mb[1] = MSW(risc_addr);
 361                 mcp->mb[2] = LSW(risc_addr);
 362                 mcp->mb[3] = 0;
 363                 mcp->mb[4] = 0;
 364                 mcp->out_mb |= MBX_4|MBX_3|MBX_2|MBX_1;
 365                 mcp->in_mb |= MBX_1;
 366         } else {
 367                 mcp->mb[1] = LSW(risc_addr);
 368                 mcp->out_mb |= MBX_1;
 369                 if (IS_QLA2322(ha) || IS_QLA6322(ha)) {
 370                         mcp->mb[2] = 0;
 371                         mcp->out_mb |= MBX_2;
 372                 }
 373         }
 374
 375         mcp->tov = MBX_TOV_SECONDS;
 376         mcp->flags = 0;
 377         rval = qla2x00_mailbox_command(vha, mcp);
 378
 379         if (rval != QLA_SUCCESS) {
 380                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x.\n", __func__,
 381                     vha->host_no, rval, mcp->mb[0]));
 382         } else {
 383                 if (IS_FWI2_CAPABLE(ha)) {
 384                         DEBUG11(printk("%s(%ld): done exchanges=%x.\n",
 385                             __func__, vha->host_no, mcp->mb[1]));
 386                 } else {
 387                         DEBUG11(printk("%s(%ld): done.\n", __func__,
 388                             vha->host_no));
 389                 }
 390         }
 391
 392         return rval;
 393 }
 394
 395 /*
 396  * qla2x00_get_fw_version
 397  *      Get firmware version.
 398  *
 399  * Input:
 400  *      ha:             adapter state pointer.
 401  *      major:          pointer for major number.
 402  *      minor:          pointer for minor number.
 403  *      subminor:       pointer for subminor number.
 404  *
 405  * Returns:
 406  *      qla2x00 local function return status code.
 407  *
 408  * Context:
 409  *      Kernel context.
 410  */
 411 void
 412 qla2x00_get_fw_version(scsi_qla_host_t *vha, uint16_t *major, uint16_t *minor,
 413     uint16_t *subminor, uint16_t *attributes, uint32_t *memory, uint8_t *mpi,
 414     uint32_t *mpi_caps, uint8_t *phy)
 415 {
 416         int             rval;
 417         mbx_cmd_t       mc;
 418         mbx_cmd_t       *mcp = &mc;
 419
 420         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
 421
 422         mcp->mb[0] = MBC_GET_FIRMWARE_VERSION;
 423         mcp->out_mb = MBX_0;
 424         mcp->in_mb = MBX_6|MBX_5|MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
 425         if (IS_QLA81XX(vha->hw))
 426                 mcp->in_mb |= MBX_13|MBX_12|MBX_11|MBX_10|MBX_9|MBX_8;
 427         mcp->flags = 0;
 428         mcp->tov = MBX_TOV_SECONDS;
 429         rval = qla2x00_mailbox_command(vha, mcp);
 430
 431         /* Return mailbox data. */
 432         *major = mcp->mb[1];
 433         *minor = mcp->mb[2];
 434         *subminor = mcp->mb[3];
 435         *attributes = mcp->mb[6];
 436         if (IS_QLA2100(vha->hw) || IS_QLA2200(vha->hw))
 437                 *memory = 0x1FFFF;                      /* Defaults to 128KB. */
 438         else
 439                 *memory = (mcp->mb[5] << 16) | mcp->mb[4];
 440         if (IS_QLA81XX(vha->hw)) {
 441                 mpi[0] = mcp->mb[10] & 0xff;
 442                 mpi[1] = mcp->mb[11] >> 8;
 443                 mpi[2] = mcp->mb[11] & 0xff;
 444                 *mpi_caps = (mcp->mb[12] << 16) | mcp->mb[13];
 445                 phy[0] = mcp->mb[8] & 0xff;
 446                 phy[1] = mcp->mb[9] >> 8;
 447                 phy[2] = mcp->mb[9] & 0xff;
 448         }
 449
 450         if (rval != QLA_SUCCESS) {
 451                 /*EMPTY*/
 452                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n", __func__,
 453                     vha->host_no, rval));
 454         } else {
 455                 /*EMPTY*/
 456                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
 457         }
 458 }
 459
 460 /*
 461  * qla2x00_get_fw_options
 462  *      Set firmware options.
 463  *
 464  * Input:
 465  *      ha = adapter block pointer.
 466  *      fwopt = pointer for firmware options.
 467  *
 468  * Returns:
 469  *      qla2x00 local function return status code.
 470  *
 471  * Context:
 472  *      Kernel context.
 473  */
 474 int
 475 qla2x00_get_fw_options(scsi_qla_host_t *vha, uint16_t *fwopts)
 476 {
 477         int rval;
 478         mbx_cmd_t mc;
 479         mbx_cmd_t *mcp = &mc;
 480
 481         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
 482
 483         mcp->mb[0] = MBC_GET_FIRMWARE_OPTION;
 484         mcp->out_mb = MBX_0;
 485         mcp->in_mb = MBX_3|MBX_2|MBX_1|MBX_0;
 486         mcp->tov = MBX_TOV_SECONDS;
 487         mcp->flags = 0;
 488         rval = qla2x00_mailbox_command(vha, mcp);
 489
 490         if (rval != QLA_SUCCESS) {
 491                 /*EMPTY*/
 492                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n", __func__,
 493                     vha->host_no, rval));
 494         } else {
 495                 fwopts[0] = mcp->mb[0];
 496                 fwopts[1] = mcp->mb[1];
 497                 fwopts[2] = mcp->mb[2];
 498                 fwopts[3] = mcp->mb[3];
 499
 500                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
 501         }
 502
 503         return rval;
 504 }
 505
 506
 507 /*
 508  * qla2x00_set_fw_options
 509  *      Set firmware options.
 510  *
 511  * Input:
 512  *      ha = adapter block pointer.
 513  *      fwopt = pointer for firmware options.
 514  *
 515  * Returns:
 516  *      qla2x00 local function return status code.
 517  *
 518  * Context:
 519  *      Kernel context.
 520  */
 521 int
 522 qla2x00_set_fw_options(scsi_qla_host_t *vha, uint16_t *fwopts)
 523 {
 524         int rval;
 525         mbx_cmd_t mc;
 526         mbx_cmd_t *mcp = &mc;
 527
 528         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
 529
 530         mcp->mb[0] = MBC_SET_FIRMWARE_OPTION;
 531         mcp->mb[1] = fwopts[1];
 532         mcp->mb[2] = fwopts[2];
 533         mcp->mb[3] = fwopts[3];
 534         mcp->out_mb = MBX_3|MBX_2|MBX_1|MBX_0;
 535         mcp->in_mb = MBX_0;
 536         if (IS_FWI2_CAPABLE(vha->hw)) {
 537                 mcp->in_mb |= MBX_1;
 538         } else {
 539                 mcp->mb[10] = fwopts[10];
 540                 mcp->mb[11] = fwopts[11];
 541                 mcp->mb[12] = 0;        /* Undocumented, but used */
 542                 mcp->out_mb |= MBX_12|MBX_11|MBX_10;
 543         }
 544         mcp->tov = MBX_TOV_SECONDS;
 545         mcp->flags = 0;
 546         rval = qla2x00_mailbox_command(vha, mcp);
 547
 548         fwopts[0] = mcp->mb[0];
 549
 550         if (rval != QLA_SUCCESS) {
 551                 /*EMPTY*/
 552                 DEBUG2_3_11(printk("%s(%ld): failed=%x (%x/%x).\n", __func__,
 553                     vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
 554         } else {
 555                 /*EMPTY*/
 556                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
 557         }
 558
 559         return rval;
 560 }
 561
 562 /*
 563  * qla2x00_mbx_reg_test
 564  *      Mailbox register wrap test.
 565  *
 566  * Input:
 567  *      ha = adapter block pointer.
 568  *      TARGET_QUEUE_LOCK must be released.
 569  *      ADAPTER_STATE_LOCK must be released.
 570  *
 571  * Returns:
 572  *      qla2x00 local function return status code.
 573  *
 574  * Context:
 575  *      Kernel context.
 576  */
 577 int
 578 qla2x00_mbx_reg_test(scsi_qla_host_t *vha)
 579 {
 580         int rval;
 581         mbx_cmd_t mc;
 582         mbx_cmd_t *mcp = &mc;
 583
 584         DEBUG11(printk("qla2x00_mbx_reg_test(%ld): entered.\n", vha->host_no));
 585
 586         mcp->mb[0] = MBC_MAILBOX_REGISTER_TEST;
 587         mcp->mb[1] = 0xAAAA;
 588         mcp->mb[2] = 0x5555;
 589         mcp->mb[3] = 0xAA55;
 590         mcp->mb[4] = 0x55AA;
 591         mcp->mb[5] = 0xA5A5;
 592         mcp->mb[6] = 0x5A5A;
 593         mcp->mb[7] = 0x2525;
 594         mcp->out_mb = MBX_7|MBX_6|MBX_5|MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
 595         mcp->in_mb = MBX_7|MBX_6|MBX_5|MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
 596         mcp->tov = MBX_TOV_SECONDS;
 597         mcp->flags = 0;
 598         rval = qla2x00_mailbox_command(vha, mcp);
 599
 600         if (rval == QLA_SUCCESS) {
 601                 if (mcp->mb[1] != 0xAAAA || mcp->mb[2] != 0x5555 ||
 602                     mcp->mb[3] != 0xAA55 || mcp->mb[4] != 0x55AA)
 603                         rval = QLA_FUNCTION_FAILED;
 604                 if (mcp->mb[5] != 0xA5A5 || mcp->mb[6] != 0x5A5A ||
 605                     mcp->mb[7] != 0x2525)
 606                         rval = QLA_FUNCTION_FAILED;
 607         }
 608
 609         if (rval != QLA_SUCCESS) {
 610                 /*EMPTY*/
 611                 DEBUG2_3_11(printk("qla2x00_mbx_reg_test(%ld): failed=%x.\n",
 612                     vha->host_no, rval));
 613         } else {
 614                 /*EMPTY*/
 615                 DEBUG11(printk("qla2x00_mbx_reg_test(%ld): done.\n",
 616                     vha->host_no));
 617         }
 618
 619         return rval;
 620 }
 621
 622 /*
 623  * qla2x00_verify_checksum
 624  *      Verify firmware checksum.
 625  *
 626  * Input:
 627  *      ha = adapter block pointer.
 628  *      TARGET_QUEUE_LOCK must be released.
 629  *      ADAPTER_STATE_LOCK must be released.
 630  *
 631  * Returns:
 632  *      qla2x00 local function return status code.
 633  *
 634  * Context:
 635  *      Kernel context.
 636  */
 637 int
 638 qla2x00_verify_checksum(scsi_qla_host_t *vha, uint32_t risc_addr)
 639 {
 640         int rval;
 641         mbx_cmd_t mc;
 642         mbx_cmd_t *mcp = &mc;
 643
 644         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
 645
 646         mcp->mb[0] = MBC_VERIFY_CHECKSUM;
 647         mcp->out_mb = MBX_0;
 648         mcp->in_mb = MBX_0;
 649         if (IS_FWI2_CAPABLE(vha->hw)) {
 650                 mcp->mb[1] = MSW(risc_addr);
 651                 mcp->mb[2] = LSW(risc_addr);
 652                 mcp->out_mb |= MBX_2|MBX_1;
 653                 mcp->in_mb |= MBX_2|MBX_1;
 654         } else {
 655                 mcp->mb[1] = LSW(risc_addr);
 656                 mcp->out_mb |= MBX_1;
 657                 mcp->in_mb |= MBX_1;
 658         }
 659
 660         mcp->tov = MBX_TOV_SECONDS;
 661         mcp->flags = 0;
 662         rval = qla2x00_mailbox_command(vha, mcp);
 663
 664         if (rval != QLA_SUCCESS) {
 665                 DEBUG2_3_11(printk("%s(%ld): failed=%x chk sum=%x.\n", __func__,
 666                     vha->host_no, rval, IS_FWI2_CAPABLE(vha->hw) ?
 667                     (mcp->mb[2] << 16) | mcp->mb[1]: mcp->mb[1]));
 668         } else {
 669                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
 670         }
 671
 672         return rval;
 673 }
 674
 675 /*
 676  * qla2x00_issue_iocb
 677  *      Issue IOCB using mailbox command
 678  *
 679  * Input:
 680  *      ha = adapter state pointer.
 681  *      buffer = buffer pointer.
 682  *      phys_addr = physical address of buffer.
 683  *      size = size of buffer.
 684  *      TARGET_QUEUE_LOCK must be released.
 685  *      ADAPTER_STATE_LOCK must be released.
 686  *
 687  * Returns:
 688  *      qla2x00 local function return status code.
 689  *
 690  * Context:
 691  *      Kernel context.
 692  */
 693 static int
 694 qla2x00_issue_iocb_timeout(scsi_qla_host_t *vha, void *buffer,
 695     dma_addr_t phys_addr, size_t size, uint32_t tov)
 696 {
 697         int             rval;
 698         mbx_cmd_t       mc;
 699         mbx_cmd_t       *mcp = &mc;
 700
 701         mcp->mb[0] = MBC_IOCB_COMMAND_A64;
 702         mcp->mb[1] = 0;
 703         mcp->mb[2] = MSW(phys_addr);
 704         mcp->mb[3] = LSW(phys_addr);
 705         mcp->mb[6] = MSW(MSD(phys_addr));
 706         mcp->mb[7] = LSW(MSD(phys_addr));
 707         mcp->out_mb = MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
 708         mcp->in_mb = MBX_2|MBX_0;
 709         mcp->tov = tov;
 710         mcp->flags = 0;
 711         rval = qla2x00_mailbox_command(vha, mcp);
 712
 713         if (rval != QLA_SUCCESS) {
 714                 /*EMPTY*/
 715                 DEBUG(printk("qla2x00_issue_iocb(%ld): failed rval 0x%x\n",
 716                     vha->host_no, rval));
 717         } else {
 718                 sts_entry_t *sts_entry = (sts_entry_t *) buffer;
 719
 720                 /* Mask reserved bits. */
 721                 sts_entry->entry_status &=
 722                     IS_FWI2_CAPABLE(vha->hw) ? RF_MASK_24XX : RF_MASK;
 723         }
 724
 725         return rval;
 726 }
 727
 728 int
 729 qla2x00_issue_iocb(scsi_qla_host_t *vha, void *buffer, dma_addr_t phys_addr,
 730     size_t size)
 731 {
 732         return qla2x00_issue_iocb_timeout(vha, buffer, phys_addr, size,
 733             MBX_TOV_SECONDS);
 734 }
 735
 736 /*
 737  * qla2x00_abort_command
 738  *      Abort command aborts a specified IOCB.
 739  *
 740  * Input:
 741  *      ha = adapter block pointer.
 742  *      sp = SB structure pointer.
 743  *
 744  * Returns:
 745  *      qla2x00 local function return status code.
 746  *
 747  * Context:
 748  *      Kernel context.
 749  */
 750 int
 751 qla2x00_abort_command(srb_t *sp)
 752 {
 753         unsigned long   flags = 0;
 754         int             rval;
 755         uint32_t        handle = 0;
 756         mbx_cmd_t       mc;
 757         mbx_cmd_t       *mcp = &mc;
 758         fc_port_t       *fcport = sp->fcport;
 759         scsi_qla_host_t *vha = fcport->vha;
 760         struct qla_hw_data *ha = vha->hw;
 761         struct req_que *req = vha->req;
 762
 763         DEBUG11(printk("qla2x00_abort_command(%ld): entered.\n", vha->host_no));
 764
 765         spin_lock_irqsave(&ha->hardware_lock, flags);
 766         for (handle = 1; handle < MAX_OUTSTANDING_COMMANDS; handle++) {
 767                 if (req->outstanding_cmds[handle] == sp)
 768                         break;
 769         }
 770         spin_unlock_irqrestore(&ha->hardware_lock, flags);
 771
 772         if (handle == MAX_OUTSTANDING_COMMANDS) {
 773                 /* command not found */
 774                 return QLA_FUNCTION_FAILED;
 775         }
 776
 777         mcp->mb[0] = MBC_ABORT_COMMAND;
 778         if (HAS_EXTENDED_IDS(ha))
 779                 mcp->mb[1] = fcport->loop_id;
 780         else
 781                 mcp->mb[1] = fcport->loop_id << 8;
 782         mcp->mb[2] = (uint16_t)handle;
 783         mcp->mb[3] = (uint16_t)(handle >> 16);
 784         mcp->mb[6] = (uint16_t)sp->cmd->device->lun;
 785         mcp->out_mb = MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
 786         mcp->in_mb = MBX_0;
 787         mcp->tov = MBX_TOV_SECONDS;
 788         mcp->flags = 0;
 789         rval = qla2x00_mailbox_command(vha, mcp);
 790
 791         if (rval != QLA_SUCCESS) {
 792                 DEBUG2_3_11(printk("qla2x00_abort_command(%ld): failed=%x.\n",
 793                     vha->host_no, rval));
 794         } else {
 795                 DEBUG11(printk("qla2x00_abort_command(%ld): done.\n",
 796                     vha->host_no));
 797         }
 798
 799         return rval;
 800 }
 801
 802 int
 803 qla2x00_abort_target(struct fc_port *fcport, unsigned int l, int tag)
 804 {
 805         int rval, rval2;
 806         mbx_cmd_t  mc;
 807         mbx_cmd_t  *mcp = &mc;
 808         scsi_qla_host_t *vha;
 809         struct req_que *req;
 810         struct rsp_que *rsp;
 811
 812         DEBUG11(printk("%s(%ld): entered.\n", __func__, fcport->vha->host_no));
 813
 814         l = l;
 815         vha = fcport->vha;
 816         req = vha->hw->req_q_map[tag];
 817         rsp = vha->hw->rsp_q_map[tag];
 818         mcp->mb[0] = MBC_ABORT_TARGET;
 819         mcp->out_mb = MBX_9|MBX_2|MBX_1|MBX_0;
 820         if (HAS_EXTENDED_IDS(vha->hw)) {
 821                 mcp->mb[1] = fcport->loop_id;
 822                 mcp->mb[10] = 0;
 823                 mcp->out_mb |= MBX_10;
 824         } else {
 825                 mcp->mb[1] = fcport->loop_id << 8;
 826         }
 827         mcp->mb[2] = vha->hw->loop_reset_delay;
 828         mcp->mb[9] = vha->vp_idx;
 829
 830         mcp->in_mb = MBX_0;
 831         mcp->tov = MBX_TOV_SECONDS;
 832         mcp->flags = 0;
 833         rval = qla2x00_mailbox_command(vha, mcp);
 834         if (rval != QLA_SUCCESS) {
 835                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n", __func__,
 836                     vha->host_no, rval));
 837         }
 838
 839         /* Issue marker IOCB. */
 840         rval2 = qla2x00_marker(vha, req, rsp, fcport->loop_id, 0,
 841                                                         MK_SYNC_ID);
 842         if (rval2 != QLA_SUCCESS) {
 843                 DEBUG2_3_11(printk("%s(%ld): failed to issue Marker IOCB "
 844                     "(%x).\n", __func__, vha->host_no, rval2));
 845         } else {
 846                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
 847         }
 848
 849         return rval;
 850 }
 851
 852 int
 853 qla2x00_lun_reset(struct fc_port *fcport, unsigned int l, int tag)
 854 {
 855         int rval, rval2;
 856         mbx_cmd_t  mc;
 857         mbx_cmd_t  *mcp = &mc;
 858         scsi_qla_host_t *vha;
 859         struct req_que *req;
 860         struct rsp_que *rsp;
 861
 862         DEBUG11(printk("%s(%ld): entered.\n", __func__, fcport->vha->host_no));
 863
 864         vha = fcport->vha;
 865         req = vha->hw->req_q_map[tag];
 866         rsp = vha->hw->rsp_q_map[tag];
 867         mcp->mb[0] = MBC_LUN_RESET;
 868         mcp->out_mb = MBX_9|MBX_3|MBX_2|MBX_1|MBX_0;
 869         if (HAS_EXTENDED_IDS(vha->hw))
 870                 mcp->mb[1] = fcport->loop_id;
 871         else
 872                 mcp->mb[1] = fcport->loop_id << 8;
 873         mcp->mb[2] = l;
 874         mcp->mb[3] = 0;
 875         mcp->mb[9] = vha->vp_idx;
 876
 877         mcp->in_mb = MBX_0;
 878         mcp->tov = MBX_TOV_SECONDS;
 879         mcp->flags = 0;
 880         rval = qla2x00_mailbox_command(vha, mcp);
 881         if (rval != QLA_SUCCESS) {
 882                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n", __func__,
 883                     vha->host_no, rval));
 884         }
 885
 886         /* Issue marker IOCB. */
 887         rval2 = qla2x00_marker(vha, req, rsp, fcport->loop_id, l,
 888                                                                 MK_SYNC_ID_LUN);
 889         if (rval2 != QLA_SUCCESS) {
 890                 DEBUG2_3_11(printk("%s(%ld): failed to issue Marker IOCB "
 891                     "(%x).\n", __func__, vha->host_no, rval2));
 892         } else {
 893                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
 894         }
 895
 896         return rval;
 897 }
 898
 899 /*
 900  * qla2x00_get_adapter_id
 901  *      Get adapter ID and topology.
 902  *
 903  * Input:
 904  *      ha = adapter block pointer.
 905  *      id = pointer for loop ID.
 906  *      al_pa = pointer for AL_PA.
 907  *      area = pointer for area.
 908  *      domain = pointer for domain.
 909  *      top = pointer for topology.
 910  *      TARGET_QUEUE_LOCK must be released.
 911  *      ADAPTER_STATE_LOCK must be released.
 912  *
 913  * Returns:
 914  *      qla2x00 local function return status code.
 915  *
 916  * Context:
 917  *      Kernel context.
 918  */
 919 int
 920 qla2x00_get_adapter_id(scsi_qla_host_t *vha, uint16_t *id, uint8_t *al_pa,
 921     uint8_t *area, uint8_t *domain, uint16_t *top, uint16_t *sw_cap)
 922 {
 923         int rval;
 924         mbx_cmd_t mc;
 925         mbx_cmd_t *mcp = &mc;
 926
 927         DEBUG11(printk("qla2x00_get_adapter_id(%ld): entered.\n",
 928             vha->host_no));
 929
 930         mcp->mb[0] = MBC_GET_ADAPTER_LOOP_ID;
 931         mcp->mb[9] = vha->vp_idx;
 932         mcp->out_mb = MBX_9|MBX_0;
 933         mcp->in_mb = MBX_9|MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
 934         if (IS_QLA81XX(vha->hw))
 935                 mcp->in_mb |= MBX_13|MBX_12|MBX_11|MBX_10;
 936         mcp->tov = MBX_TOV_SECONDS;
 937         mcp->flags = 0;
 938         rval = qla2x00_mailbox_command(vha, mcp);
 939         if (mcp->mb[0] == MBS_COMMAND_ERROR)
 940                 rval = QLA_COMMAND_ERROR;
 941         else if (mcp->mb[0] == MBS_INVALID_COMMAND)
 942                 rval = QLA_INVALID_COMMAND;
 943
 944         /* Return data. */
 945         *id = mcp->mb[1];
 946         *al_pa = LSB(mcp->mb[2]);
 947         *area = MSB(mcp->mb[2]);
 948         *domain = LSB(mcp->mb[3]);
 949         *top = mcp->mb[6];
 950         *sw_cap = mcp->mb[7];
 951
 952         if (rval != QLA_SUCCESS) {
 953                 /*EMPTY*/
 954                 DEBUG2_3_11(printk("qla2x00_get_adapter_id(%ld): failed=%x.\n",
 955                     vha->host_no, rval));
 956         } else {
 957                 DEBUG11(printk("qla2x00_get_adapter_id(%ld): done.\n",
 958                     vha->host_no));
 959
 960                 if (IS_QLA81XX(vha->hw)) {
 961                         vha->fcoe_vlan_id = mcp->mb[9] & 0xfff;
 962                         vha->fcoe_fcf_idx = mcp->mb[10];
 963                         vha->fcoe_vn_port_mac[5] = mcp->mb[11] >> 8;
 964                         vha->fcoe_vn_port_mac[4] = mcp->mb[11] & 0xff;
 965                         vha->fcoe_vn_port_mac[3] = mcp->mb[12] >> 8;
 966                         vha->fcoe_vn_port_mac[2] = mcp->mb[12] & 0xff;
 967                         vha->fcoe_vn_port_mac[1] = mcp->mb[13] >> 8;
 968                         vha->fcoe_vn_port_mac[0] = mcp->mb[13] & 0xff;
 969                 }
 970         }
 971
 972         return rval;
 973 }
 974
 975 /*
 976  * qla2x00_get_retry_cnt
 977  *      Get current firmware login retry count and delay.
 978  *
 979  * Input:
 980  *      ha = adapter block pointer.
 981  *      retry_cnt = pointer to login retry count.
 982  *      tov = pointer to login timeout value.
 983  *
 984  * Returns:
 985  *      qla2x00 local function return status code.
 986  *
 987  * Context:
 988  *      Kernel context.
 989  */
 990 int
 991 qla2x00_get_retry_cnt(scsi_qla_host_t *vha, uint8_t *retry_cnt, uint8_t *tov,
 992     uint16_t *r_a_tov)
 993 {
 994         int rval;
 995         uint16_t ratov;
 996         mbx_cmd_t mc;
 997         mbx_cmd_t *mcp = &mc;
 998
 999         DEBUG11(printk("qla2x00_get_retry_cnt(%ld): entered.\n",
1000                         vha->host_no));
1001
1002         mcp->mb[0] = MBC_GET_RETRY_COUNT;
1003         mcp->out_mb = MBX_0;
1004         mcp->in_mb = MBX_3|MBX_2|MBX_1|MBX_0;
1005         mcp->tov = MBX_TOV_SECONDS;
1006         mcp->flags = 0;
1007         rval = qla2x00_mailbox_command(vha, mcp);
1008
1009         if (rval != QLA_SUCCESS) {
1010                 /*EMPTY*/
1011                 DEBUG2_3_11(printk("qla2x00_get_retry_cnt(%ld): failed = %x.\n",
1012                     vha->host_no, mcp->mb[0]));
1013         } else {
1014                 /* Convert returned data and check our values. */
1015                 *r_a_tov = mcp->mb[3] / 2;
1016                 ratov = (mcp->mb[3]/2) / 10;  /* mb[3] value is in 100ms */
1017                 if (mcp->mb[1] * ratov > (*retry_cnt) * (*tov)) {
1018                         /* Update to the larger values */
1019                         *retry_cnt = (uint8_t)mcp->mb[1];
1020                         *tov = ratov;
1021                 }
1022
1023                 DEBUG11(printk("qla2x00_get_retry_cnt(%ld): done. mb3=%d "
1024                     "ratov=%d.\n", vha->host_no, mcp->mb[3], ratov));
1025         }
1026
1027         return rval;
1028 }
1029
1030 /*
1031  * qla2x00_init_firmware
1032  *      Initialize adapter firmware.
1033  *
1034  * Input:
1035  *      ha = adapter block pointer.
1036  *      dptr = Initialization control block pointer.
1037  *      size = size of initialization control block.
1038  *      TARGET_QUEUE_LOCK must be released.
1039  *      ADAPTER_STATE_LOCK must be released.
1040  *
1041  * Returns:
1042  *      qla2x00 local function return status code.
1043  *
1044  * Context:
1045  *      Kernel context.
1046  */
1047 int
1048 qla2x00_init_firmware(scsi_qla_host_t *vha, uint16_t size)
1049 {
1050         int rval;
1051         mbx_cmd_t mc;
1052         mbx_cmd_t *mcp = &mc;
1053         struct qla_hw_data *ha = vha->hw;
1054
1055         DEBUG11(printk("qla2x00_init_firmware(%ld): entered.\n",
1056             vha->host_no));
1057
1058         if (ha->flags.npiv_supported)
1059                 mcp->mb[0] = MBC_MID_INITIALIZE_FIRMWARE;
1060         else
1061                 mcp->mb[0] = MBC_INITIALIZE_FIRMWARE;
1062
1063         mcp->mb[1] = 0;
1064         mcp->mb[2] = MSW(ha->init_cb_dma);
1065         mcp->mb[3] = LSW(ha->init_cb_dma);
1066         mcp->mb[6] = MSW(MSD(ha->init_cb_dma));
1067         mcp->mb[7] = LSW(MSD(ha->init_cb_dma));
1068         mcp->out_mb = MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
1069         if (IS_QLA81XX(ha) && ha->ex_init_cb->ex_version) {
1070                 mcp->mb[1] = BIT_0;
1071                 mcp->mb[10] = MSW(ha->ex_init_cb_dma);
1072                 mcp->mb[11] = LSW(ha->ex_init_cb_dma);
1073                 mcp->mb[12] = MSW(MSD(ha->ex_init_cb_dma));
1074                 mcp->mb[13] = LSW(MSD(ha->ex_init_cb_dma));
1075                 mcp->mb[14] = sizeof(*ha->ex_init_cb);
1076                 mcp->out_mb |= MBX_14|MBX_13|MBX_12|MBX_11|MBX_10;
1077         }
1078         mcp->in_mb = MBX_0;
1079         mcp->buf_size = size;
1080         mcp->flags = MBX_DMA_OUT;
1081         mcp->tov = MBX_TOV_SECONDS;
1082         rval = qla2x00_mailbox_command(vha, mcp);
1083
1084         if (rval != QLA_SUCCESS) {
1085                 /*EMPTY*/
1086                 DEBUG2_3_11(printk("qla2x00_init_firmware(%ld): failed=%x "
1087                     "mb0=%x.\n",
1088                     vha->host_no, rval, mcp->mb[0]));
1089         } else {
1090                 /*EMPTY*/
1091                 DEBUG11(printk("qla2x00_init_firmware(%ld): done.\n",
1092                     vha->host_no));
1093         }
1094
1095         return rval;
1096 }
1097
1098 /*
1099  * qla2x00_get_port_database
1100  *      Issue normal/enhanced get port database mailbox command
1101  *      and copy device name as necessary.
1102  *
1103  * Input:
1104  *      ha = adapter state pointer.
1105  *      dev = structure pointer.
1106  *      opt = enhanced cmd option byte.
1107  *
1108  * Returns:
1109  *      qla2x00 local function return status code.
1110  *
1111  * Context:
1112  *      Kernel context.
1113  */
1114 int
1115 qla2x00_get_port_database(scsi_qla_host_t *vha, fc_port_t *fcport, uint8_t opt)
1116 {
1117         int rval;
1118         mbx_cmd_t mc;
1119         mbx_cmd_t *mcp = &mc;
1120         port_database_t *pd;
1121         struct port_database_24xx *pd24;
1122         dma_addr_t pd_dma;
1123         struct qla_hw_data *ha = vha->hw;
1124
1125         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
1126
1127         pd24 = NULL;
1128         pd = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &pd_dma);
1129         if (pd  == NULL) {
1130                 DEBUG2_3(printk("%s(%ld): failed to allocate Port Database "
1131                     "structure.\n", __func__, vha->host_no));
1132                 return QLA_MEMORY_ALLOC_FAILED;
1133         }
1134         memset(pd, 0, max(PORT_DATABASE_SIZE, PORT_DATABASE_24XX_SIZE));
1135
1136         mcp->mb[0] = MBC_GET_PORT_DATABASE;
1137         if (opt != 0 && !IS_FWI2_CAPABLE(ha))
1138                 mcp->mb[0] = MBC_ENHANCED_GET_PORT_DATABASE;
1139         mcp->mb[2] = MSW(pd_dma);
1140         mcp->mb[3] = LSW(pd_dma);
1141         mcp->mb[6] = MSW(MSD(pd_dma));
1142         mcp->mb[7] = LSW(MSD(pd_dma));
1143         mcp->mb[9] = vha->vp_idx;
1144         mcp->out_mb = MBX_9|MBX_7|MBX_6|MBX_3|MBX_2|MBX_0;
1145         mcp->in_mb = MBX_0;
1146         if (IS_FWI2_CAPABLE(ha)) {
1147                 mcp->mb[1] = fcport->loop_id;
1148                 mcp->mb[10] = opt;
1149                 mcp->out_mb |= MBX_10|MBX_1;
1150                 mcp->in_mb |= MBX_1;
1151         } else if (HAS_EXTENDED_IDS(ha)) {
1152                 mcp->mb[1] = fcport->loop_id;
1153                 mcp->mb[10] = opt;
1154                 mcp->out_mb |= MBX_10|MBX_1;
1155         } else {
1156                 mcp->mb[1] = fcport->loop_id << 8 | opt;
1157                 mcp->out_mb |= MBX_1;
1158         }
1159         mcp->buf_size = IS_FWI2_CAPABLE(ha) ?
1160             PORT_DATABASE_24XX_SIZE : PORT_DATABASE_SIZE;
1161         mcp->flags = MBX_DMA_IN;
1162         mcp->tov = (ha->login_timeout * 2) + (ha->login_timeout / 2);
1163         rval = qla2x00_mailbox_command(vha, mcp);
1164         if (rval != QLA_SUCCESS)
1165                 goto gpd_error_out;
1166
1167         if (IS_FWI2_CAPABLE(ha)) {
1168                 pd24 = (struct port_database_24xx *) pd;
1169
1170                 /* Check for logged in state. */
1171                 if (pd24->current_login_state != PDS_PRLI_COMPLETE &&
1172                     pd24->last_login_state != PDS_PRLI_COMPLETE) {
1173                         DEBUG2(printk("%s(%ld): Unable to verify "
1174                             "login-state (%x/%x) for loop_id %x\n",
1175                             __func__, vha->host_no,
1176                             pd24->current_login_state,
1177                             pd24->last_login_state, fcport->loop_id));
1178                         rval = QLA_FUNCTION_FAILED;
1179                         goto gpd_error_out;
1180                 }
1181
1182                 /* Names are little-endian. */
1183                 memcpy(fcport->node_name, pd24->node_name, WWN_SIZE);
1184                 memcpy(fcport->port_name, pd24->port_name, WWN_SIZE);
1185
1186                 /* Get port_id of device. */
1187                 fcport->d_id.b.domain = pd24->port_id[0];
1188                 fcport->d_id.b.area = pd24->port_id[1];
1189                 fcport->d_id.b.al_pa = pd24->port_id[2];
1190                 fcport->d_id.b.rsvd_1 = 0;
1191
1192                 /* If not target must be initiator or unknown type. */
1193                 if ((pd24->prli_svc_param_word_3[0] & BIT_4) == 0)
1194                         fcport->port_type = FCT_INITIATOR;
1195                 else
1196                         fcport->port_type = FCT_TARGET;
1197         } else {
1198                 /* Check for logged in state. */
1199                 if (pd->master_state != PD_STATE_PORT_LOGGED_IN &&
1200                     pd->slave_state != PD_STATE_PORT_LOGGED_IN) {
1201                         rval = QLA_FUNCTION_FAILED;
1202                         goto gpd_error_out;
1203                 }
1204
1205                 /* Names are little-endian. */
1206                 memcpy(fcport->node_name, pd->node_name, WWN_SIZE);
1207                 memcpy(fcport->port_name, pd->port_name, WWN_SIZE);
1208
1209                 /* Get port_id of device. */
1210                 fcport->d_id.b.domain = pd->port_id[0];
1211                 fcport->d_id.b.area = pd->port_id[3];
1212                 fcport->d_id.b.al_pa = pd->port_id[2];
1213                 fcport->d_id.b.rsvd_1 = 0;
1214
1215                 /* If not target must be initiator or unknown type. */
1216                 if ((pd->prli_svc_param_word_3[0] & BIT_4) == 0)
1217                         fcport->port_type = FCT_INITIATOR;
1218                 else
1219                         fcport->port_type = FCT_TARGET;
1220
1221                 /* Passback COS information. */
1222                 fcport->supported_classes = (pd->options & BIT_4) ?
1223                     FC_COS_CLASS2: FC_COS_CLASS3;
1224         }
1225
1226 gpd_error_out:
1227         dma_pool_free(ha->s_dma_pool, pd, pd_dma);
1228
1229         if (rval != QLA_SUCCESS) {
1230                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x mb[1]=%x.\n",
1231                     __func__, vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
1232         } else {
1233                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
1234         }
1235
1236         return rval;
1237 }
1238
1239 /*
1240  * qla2x00_get_firmware_state
1241  *      Get adapter firmware state.
1242  *
1243  * Input:
1244  *      ha = adapter block pointer.
1245  *      dptr = pointer for firmware state.
1246  *      TARGET_QUEUE_LOCK must be released.
1247  *      ADAPTER_STATE_LOCK must be released.
1248  *
1249  * Returns:
1250  *      qla2x00 local function return status code.
1251  *
1252  * Context:
1253  *      Kernel context.
1254  */
1255 int
1256 qla2x00_get_firmware_state(scsi_qla_host_t *vha, uint16_t *states)
1257 {
1258         int rval;
1259         mbx_cmd_t mc;
1260         mbx_cmd_t *mcp = &mc;
1261
1262         DEBUG11(printk("qla2x00_get_firmware_state(%ld): entered.\n",
1263             vha->host_no));
1264
1265         mcp->mb[0] = MBC_GET_FIRMWARE_STATE;
1266         mcp->out_mb = MBX_0;
1267         mcp->in_mb = MBX_3|MBX_2|MBX_1|MBX_0;
1268         mcp->tov = MBX_TOV_SECONDS;
1269         mcp->flags = 0;
1270         rval = qla2x00_mailbox_command(vha, mcp);
1271
1272         /* Return firmware states. */
1273         states[0] = mcp->mb[1];
1274         states[1] = mcp->mb[2];
1275         states[2] = mcp->mb[3];
1276
1277         if (rval != QLA_SUCCESS) {
1278                 /*EMPTY*/
1279                 DEBUG2_3_11(printk("qla2x00_get_firmware_state(%ld): "
1280                     "failed=%x.\n", vha->host_no, rval));
1281         } else {
1282                 /*EMPTY*/
1283                 DEBUG11(printk("qla2x00_get_firmware_state(%ld): done.\n",
1284                     vha->host_no));
1285         }
1286
1287         return rval;
1288 }
1289
1290 /*
1291  * qla2x00_get_port_name
1292  *      Issue get port name mailbox command.
1293  *      Returned name is in big endian format.
1294  *
1295  * Input:
1296  *      ha = adapter block pointer.
1297  *      loop_id = loop ID of device.
1298  *      name = pointer for name.
1299  *      TARGET_QUEUE_LOCK must be released.
1300  *      ADAPTER_STATE_LOCK must be released.
1301  *
1302  * Returns:
1303  *      qla2x00 local function return status code.
1304  *
1305  * Context:
1306  *      Kernel context.
1307  */
1308 int
1309 qla2x00_get_port_name(scsi_qla_host_t *vha, uint16_t loop_id, uint8_t *name,
1310     uint8_t opt)
1311 {
1312         int rval;
1313         mbx_cmd_t mc;
1314         mbx_cmd_t *mcp = &mc;
1315
1316         DEBUG11(printk("qla2x00_get_port_name(%ld): entered.\n",
1317             vha->host_no));
1318
1319         mcp->mb[0] = MBC_GET_PORT_NAME;
1320         mcp->mb[9] = vha->vp_idx;
1321         mcp->out_mb = MBX_9|MBX_1|MBX_0;
1322         if (HAS_EXTENDED_IDS(vha->hw)) {
1323                 mcp->mb[1] = loop_id;
1324                 mcp->mb[10] = opt;
1325                 mcp->out_mb |= MBX_10;
1326         } else {
1327                 mcp->mb[1] = loop_id << 8 | opt;
1328         }
1329
1330         mcp->in_mb = MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
1331         mcp->tov = MBX_TOV_SECONDS;
1332         mcp->flags = 0;
1333         rval = qla2x00_mailbox_command(vha, mcp);
1334
1335         if (rval != QLA_SUCCESS) {
1336                 /*EMPTY*/
1337                 DEBUG2_3_11(printk("qla2x00_get_port_name(%ld): failed=%x.\n",
1338                     vha->host_no, rval));
1339         } else {
1340                 if (name != NULL) {
1341                         /* This function returns name in big endian. */
1342                         name[0] = MSB(mcp->mb[2]);
1343                         name[1] = LSB(mcp->mb[2]);
1344                         name[2] = MSB(mcp->mb[3]);
1345                         name[3] = LSB(mcp->mb[3]);
1346                         name[4] = MSB(mcp->mb[6]);
1347                         name[5] = LSB(mcp->mb[6]);
1348                         name[6] = MSB(mcp->mb[7]);
1349                         name[7] = LSB(mcp->mb[7]);
1350                 }
1351
1352                 DEBUG11(printk("qla2x00_get_port_name(%ld): done.\n",
1353                     vha->host_no));
1354         }
1355
1356         return rval;
1357 }
1358
1359 /*
1360  * qla2x00_lip_reset
1361  *      Issue LIP reset mailbox command.
1362  *
1363  * Input:
1364  *      ha = adapter block pointer.
1365  *      TARGET_QUEUE_LOCK must be released.
1366  *      ADAPTER_STATE_LOCK must be released.
1367  *
1368  * Returns:
1369  *      qla2x00 local function return status code.
1370  *
1371  * Context:
1372  *      Kernel context.
1373  */
1374 int
1375 qla2x00_lip_reset(scsi_qla_host_t *vha)
1376 {
1377         int rval;
1378         mbx_cmd_t mc;
1379         mbx_cmd_t *mcp = &mc;
1380
1381         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
1382
1383         if (IS_QLA81XX(vha->hw)) {
1384                 /* Logout across all FCFs. */
1385                 mcp->mb[0] = MBC_LIP_FULL_LOGIN;
1386                 mcp->mb[1] = BIT_1;
1387                 mcp->mb[2] = 0;
1388                 mcp->out_mb = MBX_2|MBX_1|MBX_0;
1389         } else if (IS_FWI2_CAPABLE(vha->hw)) {
1390                 mcp->mb[0] = MBC_LIP_FULL_LOGIN;
1391                 mcp->mb[1] = BIT_6;
1392                 mcp->mb[2] = 0;
1393                 mcp->mb[3] = vha->hw->loop_reset_delay;
1394                 mcp->out_mb = MBX_3|MBX_2|MBX_1|MBX_0;
1395         } else {
1396                 mcp->mb[0] = MBC_LIP_RESET;
1397                 mcp->out_mb = MBX_3|MBX_2|MBX_1|MBX_0;
1398                 if (HAS_EXTENDED_IDS(vha->hw)) {
1399                         mcp->mb[1] = 0x00ff;
1400                         mcp->mb[10] = 0;
1401                         mcp->out_mb |= MBX_10;
1402                 } else {
1403                         mcp->mb[1] = 0xff00;
1404                 }
1405                 mcp->mb[2] = vha->hw->loop_reset_delay;
1406                 mcp->mb[3] = 0;
1407         }
1408         mcp->in_mb = MBX_0;
1409         mcp->tov = MBX_TOV_SECONDS;
1410         mcp->flags = 0;
1411         rval = qla2x00_mailbox_command(vha, mcp);
1412
1413         if (rval != QLA_SUCCESS) {
1414                 /*EMPTY*/
1415                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n",
1416                     __func__, vha->host_no, rval));
1417         } else {
1418                 /*EMPTY*/
1419                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
1420         }
1421
1422         return rval;
1423 }
1424
1425 /*
1426  * qla2x00_send_sns
1427  *      Send SNS command.
1428  *
1429  * Input:
1430  *      ha = adapter block pointer.
1431  *      sns = pointer for command.
1432  *      cmd_size = command size.
1433  *      buf_size = response/command size.
1434  *      TARGET_QUEUE_LOCK must be released.
1435  *      ADAPTER_STATE_LOCK must be released.
1436  *
1437  * Returns:
1438  *      qla2x00 local function return status code.
1439  *
1440  * Context:
1441  *      Kernel context.
1442  */
1443 int
1444 qla2x00_send_sns(scsi_qla_host_t *vha, dma_addr_t sns_phys_address,
1445     uint16_t cmd_size, size_t buf_size)
1446 {
1447         int rval;
1448         mbx_cmd_t mc;
1449         mbx_cmd_t *mcp = &mc;
1450
1451         DEBUG11(printk("qla2x00_send_sns(%ld): entered.\n",
1452             vha->host_no));
1453
1454         DEBUG11(printk("qla2x00_send_sns: retry cnt=%d ratov=%d total "
1455                 "tov=%d.\n", vha->hw->retry_count, vha->hw->login_timeout,
1456                 mcp->tov));
1457
1458         mcp->mb[0] = MBC_SEND_SNS_COMMAND;
1459         mcp->mb[1] = cmd_size;
1460         mcp->mb[2] = MSW(sns_phys_address);
1461         mcp->mb[3] = LSW(sns_phys_address);
1462         mcp->mb[6] = MSW(MSD(sns_phys_address));
1463         mcp->mb[7] = LSW(MSD(sns_phys_address));
1464         mcp->out_mb = MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
1465         mcp->in_mb = MBX_0|MBX_1;
1466         mcp->buf_size = buf_size;
1467         mcp->flags = MBX_DMA_OUT|MBX_DMA_IN;
1468         mcp->tov = (vha->hw->login_timeout * 2) + (vha->hw->login_timeout / 2);
1469         rval = qla2x00_mailbox_command(vha, mcp);
1470
1471         if (rval != QLA_SUCCESS) {
1472                 /*EMPTY*/
1473                 DEBUG(printk("qla2x00_send_sns(%ld): failed=%x mb[0]=%x "
1474                     "mb[1]=%x.\n", vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
1475                 DEBUG2_3_11(printk("qla2x00_send_sns(%ld): failed=%x mb[0]=%x "
1476                     "mb[1]=%x.\n", vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
1477         } else {
1478                 /*EMPTY*/
1479                 DEBUG11(printk("qla2x00_send_sns(%ld): done.\n", vha->host_no));
1480         }
1481
1482         return rval;
1483 }
1484
1485 int
1486 qla24xx_login_fabric(scsi_qla_host_t *vha, uint16_t loop_id, uint8_t domain,
1487     uint8_t area, uint8_t al_pa, uint16_t *mb, uint8_t opt)
1488 {
1489         int             rval;
1490
1491         struct logio_entry_24xx *lg;
1492         dma_addr_t      lg_dma;
1493         uint32_t        iop[2];
1494         struct qla_hw_data *ha = vha->hw;
1495         struct req_que *req;
1496         struct rsp_que *rsp;
1497
1498         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
1499
1500         if (ql2xmultique_tag)
1501                 req = ha->req_q_map[0];
1502         else
1503                 req = vha->req;
1504         rsp = req->rsp;
1505
1506         lg = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &lg_dma);
1507         if (lg == NULL) {
1508                 DEBUG2_3(printk("%s(%ld): failed to allocate Login IOCB.\n",
1509                     __func__, vha->host_no));
1510                 return QLA_MEMORY_ALLOC_FAILED;
1511         }
1512         memset(lg, 0, sizeof(struct logio_entry_24xx));
1513
1514         lg->entry_type = LOGINOUT_PORT_IOCB_TYPE;
1515         lg->entry_count = 1;
1516         lg->handle = MAKE_HANDLE(req->id, lg->handle);
1517         lg->nport_handle = cpu_to_le16(loop_id);
1518         lg->control_flags = __constant_cpu_to_le16(LCF_COMMAND_PLOGI);
1519         if (opt & BIT_0)
1520                 lg->control_flags |= __constant_cpu_to_le16(LCF_COND_PLOGI);
1521         if (opt & BIT_1)
1522                 lg->control_flags |= __constant_cpu_to_le16(LCF_SKIP_PRLI);
1523         lg->port_id[0] = al_pa;
1524         lg->port_id[1] = area;
1525         lg->port_id[2] = domain;
1526         lg->vp_index = vha->vp_idx;
1527         rval = qla2x00_issue_iocb(vha, lg, lg_dma, 0);
1528         if (rval != QLA_SUCCESS) {
1529                 DEBUG2_3_11(printk("%s(%ld): failed to issue Login IOCB "
1530                     "(%x).\n", __func__, vha->host_no, rval));
1531         } else if (lg->entry_status != 0) {
1532                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
1533                     "-- error status (%x).\n", __func__, vha->host_no,
1534                     lg->entry_status));
1535                 rval = QLA_FUNCTION_FAILED;
1536         } else if (lg->comp_status != __constant_cpu_to_le16(CS_COMPLETE)) {
1537                 iop[0] = le32_to_cpu(lg->io_parameter[0]);
1538                 iop[1] = le32_to_cpu(lg->io_parameter[1]);
1539
1540                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
1541                     "-- completion status (%x)  ioparam=%x/%x.\n", __func__,
1542                     vha->host_no, le16_to_cpu(lg->comp_status), iop[0],
1543                     iop[1]));
1544
1545                 switch (iop[0]) {
1546                 case LSC_SCODE_PORTID_USED:
1547                         mb[0] = MBS_PORT_ID_USED;
1548                         mb[1] = LSW(iop[1]);
1549                         break;
1550                 case LSC_SCODE_NPORT_USED:
1551                         mb[0] = MBS_LOOP_ID_USED;
1552                         break;
1553                 case LSC_SCODE_NOLINK:
1554                 case LSC_SCODE_NOIOCB:
1555                 case LSC_SCODE_NOXCB:
1556                 case LSC_SCODE_CMD_FAILED:
1557                 case LSC_SCODE_NOFABRIC:
1558                 case LSC_SCODE_FW_NOT_READY:
1559                 case LSC_SCODE_NOT_LOGGED_IN:
1560                 case LSC_SCODE_NOPCB:
1561                 case LSC_SCODE_ELS_REJECT:
1562                 case LSC_SCODE_CMD_PARAM_ERR:
1563                 case LSC_SCODE_NONPORT:
1564                 case LSC_SCODE_LOGGED_IN:
1565                 case LSC_SCODE_NOFLOGI_ACC:
1566                 default:
1567                         mb[0] = MBS_COMMAND_ERROR;
1568                         break;
1569                 }
1570         } else {
1571                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
1572
1573                 iop[0] = le32_to_cpu(lg->io_parameter[0]);
1574
1575                 mb[0] = MBS_COMMAND_COMPLETE;
1576                 mb[1] = 0;
1577                 if (iop[0] & BIT_4) {
1578                         if (iop[0] & BIT_8)
1579                                 mb[1] |= BIT_1;
1580                 } else
1581                         mb[1] = BIT_0;
1582
1583                 /* Passback COS information. */
1584                 mb[10] = 0;
1585                 if (lg->io_parameter[7] || lg->io_parameter[8])
1586                         mb[10] |= BIT_0;        /* Class 2. */
1587                 if (lg->io_parameter[9] || lg->io_parameter[10])
1588                         mb[10] |= BIT_1;        /* Class 3. */
1589         }
1590
1591         dma_pool_free(ha->s_dma_pool, lg, lg_dma);
1592
1593         return rval;
1594 }
1595
1596 /*
1597  * qla2x00_login_fabric
1598  *      Issue login fabric port mailbox command.
1599  *
1600  * Input:
1601  *      ha = adapter block pointer.
1602  *      loop_id = device loop ID.
1603  *      domain = device domain.
1604  *      area = device area.
1605  *      al_pa = device AL_PA.
1606  *      status = pointer for return status.
1607  *      opt = command options.
1608  *      TARGET_QUEUE_LOCK must be released.
1609  *      ADAPTER_STATE_LOCK must be released.
1610  *
1611  * Returns:
1612  *      qla2x00 local function return status code.
1613  *
1614  * Context:
1615  *      Kernel context.
1616  */
1617 int
1618 qla2x00_login_fabric(scsi_qla_host_t *vha, uint16_t loop_id, uint8_t domain,
1619     uint8_t area, uint8_t al_pa, uint16_t *mb, uint8_t opt)
1620 {
1621         int rval;
1622         mbx_cmd_t mc;
1623         mbx_cmd_t *mcp = &mc;
1624         struct qla_hw_data *ha = vha->hw;
1625
1626         DEBUG11(printk("qla2x00_login_fabric(%ld): entered.\n", vha->host_no));
1627
1628         mcp->mb[0] = MBC_LOGIN_FABRIC_PORT;
1629         mcp->out_mb = MBX_3|MBX_2|MBX_1|MBX_0;
1630         if (HAS_EXTENDED_IDS(ha)) {
1631                 mcp->mb[1] = loop_id;
1632                 mcp->mb[10] = opt;
1633                 mcp->out_mb |= MBX_10;
1634         } else {
1635                 mcp->mb[1] = (loop_id << 8) | opt;
1636         }
1637         mcp->mb[2] = domain;
1638         mcp->mb[3] = area << 8 | al_pa;
1639
1640         mcp->in_mb = MBX_7|MBX_6|MBX_2|MBX_1|MBX_0;
1641         mcp->tov = (ha->login_timeout * 2) + (ha->login_timeout / 2);
1642         mcp->flags = 0;
1643         rval = qla2x00_mailbox_command(vha, mcp);
1644
1645         /* Return mailbox statuses. */
1646         if (mb != NULL) {
1647                 mb[0] = mcp->mb[0];
1648                 mb[1] = mcp->mb[1];
1649                 mb[2] = mcp->mb[2];
1650                 mb[6] = mcp->mb[6];
1651                 mb[7] = mcp->mb[7];
1652                 /* COS retrieved from Get-Port-Database mailbox command. */
1653                 mb[10] = 0;
1654         }
1655
1656         if (rval != QLA_SUCCESS) {
1657                 /* RLU tmp code: need to change main mailbox_command function to
1658                  * return ok even when the mailbox completion value is not
1659                  * SUCCESS. The caller needs to be responsible to interpret
1660                  * the return values of this mailbox command if we're not
1661                  * to change too much of the existing code.
1662                  */
1663                 if (mcp->mb[0] == 0x4001 || mcp->mb[0] == 0x4002 ||
1664                     mcp->mb[0] == 0x4003 || mcp->mb[0] == 0x4005 ||
1665                     mcp->mb[0] == 0x4006)
1666                         rval = QLA_SUCCESS;
1667
1668                 /*EMPTY*/
1669                 DEBUG2_3_11(printk("qla2x00_login_fabric(%ld): failed=%x "
1670                     "mb[0]=%x mb[1]=%x mb[2]=%x.\n", vha->host_no, rval,
1671                     mcp->mb[0], mcp->mb[1], mcp->mb[2]));
1672         } else {
1673                 /*EMPTY*/
1674                 DEBUG11(printk("qla2x00_login_fabric(%ld): done.\n",
1675                     vha->host_no));
1676         }
1677
1678         return rval;
1679 }
1680
1681 /*
1682  * qla2x00_login_local_device
1683  *           Issue login loop port mailbox command.
1684  *
1685  * Input:
1686  *           ha = adapter block pointer.
1687  *           loop_id = device loop ID.
1688  *           opt = command options.
1689  *
1690  * Returns:
1691  *            Return status code.
1692  *
1693  * Context:
1694  *            Kernel context.
1695  *
1696  */
1697 int
1698 qla2x00_login_local_device(scsi_qla_host_t *vha, fc_port_t *fcport,
1699     uint16_t *mb_ret, uint8_t opt)
1700 {
1701         int rval;
1702         mbx_cmd_t mc;
1703         mbx_cmd_t *mcp = &mc;
1704         struct qla_hw_data *ha = vha->hw;
1705
1706         if (IS_FWI2_CAPABLE(ha))
1707                 return qla24xx_login_fabric(vha, fcport->loop_id,
1708                     fcport->d_id.b.domain, fcport->d_id.b.area,
1709                     fcport->d_id.b.al_pa, mb_ret, opt);
1710
1711         DEBUG3(printk("%s(%ld): entered.\n", __func__, vha->host_no));
1712
1713         mcp->mb[0] = MBC_LOGIN_LOOP_PORT;
1714         if (HAS_EXTENDED_IDS(ha))
1715                 mcp->mb[1] = fcport->loop_id;
1716         else
1717                 mcp->mb[1] = fcport->loop_id << 8;
1718         mcp->mb[2] = opt;
1719         mcp->out_mb = MBX_2|MBX_1|MBX_0;
1720         mcp->in_mb = MBX_7|MBX_6|MBX_1|MBX_0;
1721         mcp->tov = (ha->login_timeout * 2) + (ha->login_timeout / 2);
1722         mcp->flags = 0;
1723         rval = qla2x00_mailbox_command(vha, mcp);
1724
1725         /* Return mailbox statuses. */
1726         if (mb_ret != NULL) {
1727                 mb_ret[0] = mcp->mb[0];
1728                 mb_ret[1] = mcp->mb[1];
1729                 mb_ret[6] = mcp->mb[6];
1730                 mb_ret[7] = mcp->mb[7];
1731         }
1732
1733         if (rval != QLA_SUCCESS) {
1734                 /* AV tmp code: need to change main mailbox_command function to
1735                  * return ok even when the mailbox completion value is not
1736                  * SUCCESS. The caller needs to be responsible to interpret
1737                  * the return values of this mailbox command if we're not
1738                  * to change too much of the existing code.
1739                  */
1740                 if (mcp->mb[0] == 0x4005 || mcp->mb[0] == 0x4006)
1741                         rval = QLA_SUCCESS;
1742
1743                 DEBUG(printk("%s(%ld): failed=%x mb[0]=%x mb[1]=%x "
1744                     "mb[6]=%x mb[7]=%x.\n", __func__, vha->host_no, rval,
1745                     mcp->mb[0], mcp->mb[1], mcp->mb[6], mcp->mb[7]));
1746                 DEBUG2_3(printk("%s(%ld): failed=%x mb[0]=%x mb[1]=%x "
1747                     "mb[6]=%x mb[7]=%x.\n", __func__, vha->host_no, rval,
1748                     mcp->mb[0], mcp->mb[1], mcp->mb[6], mcp->mb[7]));
1749         } else {
1750                 /*EMPTY*/
1751                 DEBUG3(printk("%s(%ld): done.\n", __func__, vha->host_no));
1752         }
1753
1754         return (rval);
1755 }
1756
1757 int
1758 qla24xx_fabric_logout(scsi_qla_host_t *vha, uint16_t loop_id, uint8_t domain,
1759     uint8_t area, uint8_t al_pa)
1760 {
1761         int             rval;
1762         struct logio_entry_24xx *lg;
1763         dma_addr_t      lg_dma;
1764         struct qla_hw_data *ha = vha->hw;
1765         struct req_que *req;
1766         struct rsp_que *rsp;
1767
1768         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
1769
1770         lg = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &lg_dma);
1771         if (lg == NULL) {
1772                 DEBUG2_3(printk("%s(%ld): failed to allocate Logout IOCB.\n",
1773                     __func__, vha->host_no));
1774                 return QLA_MEMORY_ALLOC_FAILED;
1775         }
1776         memset(lg, 0, sizeof(struct logio_entry_24xx));
1777
1778         if (ql2xmaxqueues > 1)
1779                 req = ha->req_q_map[0];
1780         else
1781                 req = vha->req;
1782         rsp = req->rsp;
1783         lg->entry_type = LOGINOUT_PORT_IOCB_TYPE;
1784         lg->entry_count = 1;
1785         lg->handle = MAKE_HANDLE(req->id, lg->handle);
1786         lg->nport_handle = cpu_to_le16(loop_id);
1787         lg->control_flags =
1788             __constant_cpu_to_le16(LCF_COMMAND_LOGO|LCF_IMPL_LOGO);
1789         lg->port_id[0] = al_pa;
1790         lg->port_id[1] = area;
1791         lg->port_id[2] = domain;
1792         lg->vp_index = vha->vp_idx;
1793
1794         rval = qla2x00_issue_iocb(vha, lg, lg_dma, 0);
1795         if (rval != QLA_SUCCESS) {
1796                 DEBUG2_3_11(printk("%s(%ld): failed to issue Logout IOCB "
1797                     "(%x).\n", __func__, vha->host_no, rval));
1798         } else if (lg->entry_status != 0) {
1799                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
1800                     "-- error status (%x).\n", __func__, vha->host_no,
1801                     lg->entry_status));
1802                 rval = QLA_FUNCTION_FAILED;
1803         } else if (lg->comp_status != __constant_cpu_to_le16(CS_COMPLETE)) {
1804                 DEBUG2_3_11(printk("%s(%ld %d): failed to complete IOCB "
1805                     "-- completion status (%x)  ioparam=%x/%x.\n", __func__,
1806                     vha->host_no, vha->vp_idx, le16_to_cpu(lg->comp_status),
1807                     le32_to_cpu(lg->io_parameter[0]),
1808                     le32_to_cpu(lg->io_parameter[1])));
1809         } else {
1810                 /*EMPTY*/
1811                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
1812         }
1813
1814         dma_pool_free(ha->s_dma_pool, lg, lg_dma);
1815
1816         return rval;
1817 }
1818
1819 /*
1820  * qla2x00_fabric_logout
1821  *      Issue logout fabric port mailbox command.
1822  *
1823  * Input:
1824  *      ha = adapter block pointer.
1825  *      loop_id = device loop ID.
1826  *      TARGET_QUEUE_LOCK must be released.
1827  *      ADAPTER_STATE_LOCK must be released.
1828  *
1829  * Returns:
1830  *      qla2x00 local function return status code.
1831  *
1832  * Context:
1833  *      Kernel context.
1834  */
1835 int
1836 qla2x00_fabric_logout(scsi_qla_host_t *vha, uint16_t loop_id, uint8_t domain,
1837     uint8_t area, uint8_t al_pa)
1838 {
1839         int rval;
1840         mbx_cmd_t mc;
1841         mbx_cmd_t *mcp = &mc;
1842
1843         DEBUG11(printk("qla2x00_fabric_logout(%ld): entered.\n",
1844             vha->host_no));
1845
1846         mcp->mb[0] = MBC_LOGOUT_FABRIC_PORT;
1847         mcp->out_mb = MBX_1|MBX_0;
1848         if (HAS_EXTENDED_IDS(vha->hw)) {
1849                 mcp->mb[1] = loop_id;
1850                 mcp->mb[10] = 0;
1851                 mcp->out_mb |= MBX_10;
1852         } else {
1853                 mcp->mb[1] = loop_id << 8;
1854         }
1855
1856         mcp->in_mb = MBX_1|MBX_0;
1857         mcp->tov = MBX_TOV_SECONDS;
1858         mcp->flags = 0;
1859         rval = qla2x00_mailbox_command(vha, mcp);
1860
1861         if (rval != QLA_SUCCESS) {
1862                 /*EMPTY*/
1863                 DEBUG2_3_11(printk("qla2x00_fabric_logout(%ld): failed=%x "
1864                     "mbx1=%x.\n", vha->host_no, rval, mcp->mb[1]));
1865         } else {
1866                 /*EMPTY*/
1867                 DEBUG11(printk("qla2x00_fabric_logout(%ld): done.\n",
1868                     vha->host_no));
1869         }
1870
1871         return rval;
1872 }
1873
1874 /*
1875  * qla2x00_full_login_lip
1876  *      Issue full login LIP mailbox command.
1877  *
1878  * Input:
1879  *      ha = adapter block pointer.
1880  *      TARGET_QUEUE_LOCK must be released.
1881  *      ADAPTER_STATE_LOCK must be released.
1882  *
1883  * Returns:
1884  *      qla2x00 local function return status code.
1885  *
1886  * Context:
1887  *      Kernel context.
1888  */
1889 int
1890 qla2x00_full_login_lip(scsi_qla_host_t *vha)
1891 {
1892         int rval;
1893         mbx_cmd_t mc;
1894         mbx_cmd_t *mcp = &mc;
1895
1896         DEBUG11(printk("qla2x00_full_login_lip(%ld): entered.\n",
1897             vha->host_no));
1898
1899         mcp->mb[0] = MBC_LIP_FULL_LOGIN;
1900         mcp->mb[1] = IS_FWI2_CAPABLE(vha->hw) ? BIT_3 : 0;
1901         mcp->mb[2] = 0;
1902         mcp->mb[3] = 0;
1903         mcp->out_mb = MBX_3|MBX_2|MBX_1|MBX_0;
1904         mcp->in_mb = MBX_0;
1905         mcp->tov = MBX_TOV_SECONDS;
1906         mcp->flags = 0;
1907         rval = qla2x00_mailbox_command(vha, mcp);
1908
1909         if (rval != QLA_SUCCESS) {
1910                 /*EMPTY*/
1911                 DEBUG2_3_11(printk("qla2x00_full_login_lip(%ld): failed=%x.\n",
1912                     vha->host_no, rval));
1913         } else {
1914                 /*EMPTY*/
1915                 DEBUG11(printk("qla2x00_full_login_lip(%ld): done.\n",
1916                     vha->host_no));
1917         }
1918
1919         return rval;
1920 }
1921
1922 /*
1923  * qla2x00_get_id_list
1924  *
1925  * Input:
1926  *      ha = adapter block pointer.
1927  *
1928  * Returns:
1929  *      qla2x00 local function return status code.
1930  *
1931  * Context:
1932  *      Kernel context.
1933  */
1934 int
1935 qla2x00_get_id_list(scsi_qla_host_t *vha, void *id_list, dma_addr_t id_list_dma,
1936     uint16_t *entries)
1937 {
1938         int rval;
1939         mbx_cmd_t mc;
1940         mbx_cmd_t *mcp = &mc;
1941
1942         DEBUG11(printk("qla2x00_get_id_list(%ld): entered.\n",
1943             vha->host_no));
1944
1945         if (id_list == NULL)
1946                 return QLA_FUNCTION_FAILED;
1947
1948         mcp->mb[0] = MBC_GET_ID_LIST;
1949         mcp->out_mb = MBX_0;
1950         if (IS_FWI2_CAPABLE(vha->hw)) {
1951                 mcp->mb[2] = MSW(id_list_dma);
1952                 mcp->mb[3] = LSW(id_list_dma);
1953                 mcp->mb[6] = MSW(MSD(id_list_dma));
1954                 mcp->mb[7] = LSW(MSD(id_list_dma));
1955                 mcp->mb[8] = 0;
1956                 mcp->mb[9] = vha->vp_idx;
1957                 mcp->out_mb |= MBX_9|MBX_8|MBX_7|MBX_6|MBX_3|MBX_2;
1958         } else {
1959                 mcp->mb[1] = MSW(id_list_dma);
1960                 mcp->mb[2] = LSW(id_list_dma);
1961                 mcp->mb[3] = MSW(MSD(id_list_dma));
1962                 mcp->mb[6] = LSW(MSD(id_list_dma));
1963                 mcp->out_mb |= MBX_6|MBX_3|MBX_2|MBX_1;
1964         }
1965         mcp->in_mb = MBX_1|MBX_0;
1966         mcp->tov = MBX_TOV_SECONDS;
1967         mcp->flags = 0;
1968         rval = qla2x00_mailbox_command(vha, mcp);
1969
1970         if (rval != QLA_SUCCESS) {
1971                 /*EMPTY*/
1972                 DEBUG2_3_11(printk("qla2x00_get_id_list(%ld): failed=%x.\n",
1973                     vha->host_no, rval));
1974         } else {
1975                 *entries = mcp->mb[1];
1976                 DEBUG11(printk("qla2x00_get_id_list(%ld): done.\n",
1977                     vha->host_no));
1978         }
1979
1980         return rval;
1981 }
1982
1983 /*
1984  * qla2x00_get_resource_cnts
1985  *      Get current firmware resource counts.
1986  *
1987  * Input:
1988  *      ha = adapter block pointer.
1989  *
1990  * Returns:
1991  *      qla2x00 local function return status code.
1992  *
1993  * Context:
1994  *      Kernel context.
1995  */
1996 int
1997 qla2x00_get_resource_cnts(scsi_qla_host_t *vha, uint16_t *cur_xchg_cnt,
1998     uint16_t *orig_xchg_cnt, uint16_t *cur_iocb_cnt,
1999     uint16_t *orig_iocb_cnt, uint16_t *max_npiv_vports)
2000 {
2001         int rval;
2002         mbx_cmd_t mc;
2003         mbx_cmd_t *mcp = &mc;
2004
2005         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2006
2007         mcp->mb[0] = MBC_GET_RESOURCE_COUNTS;
2008         mcp->out_mb = MBX_0;
2009         mcp->in_mb = MBX_11|MBX_10|MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
2010         mcp->tov = MBX_TOV_SECONDS;
2011         mcp->flags = 0;
2012         rval = qla2x00_mailbox_command(vha, mcp);
2013
2014         if (rval != QLA_SUCCESS) {
2015                 /*EMPTY*/
2016                 DEBUG2_3_11(printk("%s(%ld): failed = %x.\n", __func__,
2017                     vha->host_no, mcp->mb[0]));
2018         } else {
2019                 DEBUG11(printk("%s(%ld): done. mb1=%x mb2=%x mb3=%x mb6=%x "
2020                     "mb7=%x mb10=%x mb11=%x.\n", __func__, vha->host_no,
2021                     mcp->mb[1], mcp->mb[2], mcp->mb[3], mcp->mb[6], mcp->mb[7],
2022                     mcp->mb[10], mcp->mb[11]));
2023
2024                 if (cur_xchg_cnt)
2025                         *cur_xchg_cnt = mcp->mb[3];
2026                 if (orig_xchg_cnt)
2027                         *orig_xchg_cnt = mcp->mb[6];
2028                 if (cur_iocb_cnt)
2029                         *cur_iocb_cnt = mcp->mb[7];
2030                 if (orig_iocb_cnt)
2031                         *orig_iocb_cnt = mcp->mb[10];
2032                 if (vha->hw->flags.npiv_supported && max_npiv_vports)
2033                         *max_npiv_vports = mcp->mb[11];
2034         }
2035
2036         return (rval);
2037 }
2038
2039 #if defined(QL_DEBUG_LEVEL_3)
2040 /*
2041  * qla2x00_get_fcal_position_map
2042  *      Get FCAL (LILP) position map using mailbox command
2043  *
2044  * Input:
2045  *      ha = adapter state pointer.
2046  *      pos_map = buffer pointer (can be NULL).
2047  *
2048  * Returns:
2049  *      qla2x00 local function return status code.
2050  *
2051  * Context:
2052  *      Kernel context.
2053  */
2054 int
2055 qla2x00_get_fcal_position_map(scsi_qla_host_t *vha, char *pos_map)
2056 {
2057         int rval;
2058         mbx_cmd_t mc;
2059         mbx_cmd_t *mcp = &mc;
2060         char *pmap;
2061         dma_addr_t pmap_dma;
2062         struct qla_hw_data *ha = vha->hw;
2063
2064         pmap = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &pmap_dma);
2065         if (pmap  == NULL) {
2066                 DEBUG2_3_11(printk("%s(%ld): **** Mem Alloc Failed ****",
2067                     __func__, vha->host_no));
2068                 return QLA_MEMORY_ALLOC_FAILED;
2069         }
2070         memset(pmap, 0, FCAL_MAP_SIZE);
2071
2072         mcp->mb[0] = MBC_GET_FC_AL_POSITION_MAP;
2073         mcp->mb[2] = MSW(pmap_dma);
2074         mcp->mb[3] = LSW(pmap_dma);
2075         mcp->mb[6] = MSW(MSD(pmap_dma));
2076         mcp->mb[7] = LSW(MSD(pmap_dma));
2077         mcp->out_mb = MBX_7|MBX_6|MBX_3|MBX_2|MBX_0;
2078         mcp->in_mb = MBX_1|MBX_0;
2079         mcp->buf_size = FCAL_MAP_SIZE;
2080         mcp->flags = MBX_DMA_IN;
2081         mcp->tov = (ha->login_timeout * 2) + (ha->login_timeout / 2);
2082         rval = qla2x00_mailbox_command(vha, mcp);
2083
2084         if (rval == QLA_SUCCESS) {
2085                 DEBUG11(printk("%s(%ld): (mb0=%x/mb1=%x) FC/AL Position Map "
2086                     "size (%x)\n", __func__, vha->host_no, mcp->mb[0],
2087                     mcp->mb[1], (unsigned)pmap[0]));
2088                 DEBUG11(qla2x00_dump_buffer(pmap, pmap[0] + 1));
2089
2090                 if (pos_map)
2091                         memcpy(pos_map, pmap, FCAL_MAP_SIZE);
2092         }
2093         dma_pool_free(ha->s_dma_pool, pmap, pmap_dma);
2094
2095         if (rval != QLA_SUCCESS) {
2096                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n", __func__,
2097                     vha->host_no, rval));
2098         } else {
2099                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2100         }
2101
2102         return rval;
2103 }
2104 #endif
2105
2106 /*
2107  * qla2x00_get_link_status
2108  *
2109  * Input:
2110  *      ha = adapter block pointer.
2111  *      loop_id = device loop ID.
2112  *      ret_buf = pointer to link status return buffer.
2113  *
2114  * Returns:
2115  *      0 = success.
2116  *      BIT_0 = mem alloc error.
2117  *      BIT_1 = mailbox error.
2118  */
2119 int
2120 qla2x00_get_link_status(scsi_qla_host_t *vha, uint16_t loop_id,
2121     struct link_statistics *stats, dma_addr_t stats_dma)
2122 {
2123         int rval;
2124         mbx_cmd_t mc;
2125         mbx_cmd_t *mcp = &mc;
2126         uint32_t *siter, *diter, dwords;
2127         struct qla_hw_data *ha = vha->hw;
2128
2129         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2130
2131         mcp->mb[0] = MBC_GET_LINK_STATUS;
2132         mcp->mb[2] = MSW(stats_dma);
2133         mcp->mb[3] = LSW(stats_dma);
2134         mcp->mb[6] = MSW(MSD(stats_dma));
2135         mcp->mb[7] = LSW(MSD(stats_dma));
2136         mcp->out_mb = MBX_7|MBX_6|MBX_3|MBX_2|MBX_0;
2137         mcp->in_mb = MBX_0;
2138         if (IS_FWI2_CAPABLE(ha)) {
2139                 mcp->mb[1] = loop_id;
2140                 mcp->mb[4] = 0;
2141                 mcp->mb[10] = 0;
2142                 mcp->out_mb |= MBX_10|MBX_4|MBX_1;
2143                 mcp->in_mb |= MBX_1;
2144         } else if (HAS_EXTENDED_IDS(ha)) {
2145                 mcp->mb[1] = loop_id;
2146                 mcp->mb[10] = 0;
2147                 mcp->out_mb |= MBX_10|MBX_1;
2148         } else {
2149                 mcp->mb[1] = loop_id << 8;
2150                 mcp->out_mb |= MBX_1;
2151         }
2152         mcp->tov = MBX_TOV_SECONDS;
2153         mcp->flags = IOCTL_CMD;
2154         rval = qla2x00_mailbox_command(vha, mcp);
2155
2156         if (rval == QLA_SUCCESS) {
2157                 if (mcp->mb[0] != MBS_COMMAND_COMPLETE) {
2158                         DEBUG2_3_11(printk("%s(%ld): cmd failed. mbx0=%x.\n",
2159                             __func__, vha->host_no, mcp->mb[0]));
2160                         rval = QLA_FUNCTION_FAILED;
2161                 } else {
2162                         /* Copy over data -- firmware data is LE. */
2163                         dwords = offsetof(struct link_statistics, unused1) / 4;
2164                         siter = diter = &stats->link_fail_cnt;
2165                         while (dwords--)
2166                                 *diter++ = le32_to_cpu(*siter++);
2167                 }
2168         } else {
2169                 /* Failed. */
2170                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n", __func__,
2171                     vha->host_no, rval));
2172         }
2173
2174         return rval;
2175 }
2176
2177 int
2178 qla24xx_get_isp_stats(scsi_qla_host_t *vha, struct link_statistics *stats,
2179     dma_addr_t stats_dma)
2180 {
2181         int rval;
2182         mbx_cmd_t mc;
2183         mbx_cmd_t *mcp = &mc;
2184         uint32_t *siter, *diter, dwords;
2185
2186         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2187
2188         mcp->mb[0] = MBC_GET_LINK_PRIV_STATS;
2189         mcp->mb[2] = MSW(stats_dma);
2190         mcp->mb[3] = LSW(stats_dma);
2191         mcp->mb[6] = MSW(MSD(stats_dma));
2192         mcp->mb[7] = LSW(MSD(stats_dma));
2193         mcp->mb[8] = sizeof(struct link_statistics) / 4;
2194         mcp->mb[9] = vha->vp_idx;
2195         mcp->mb[10] = 0;
2196         mcp->out_mb = MBX_10|MBX_9|MBX_8|MBX_7|MBX_6|MBX_3|MBX_2|MBX_0;
2197         mcp->in_mb = MBX_2|MBX_1|MBX_0;
2198         mcp->tov = MBX_TOV_SECONDS;
2199         mcp->flags = IOCTL_CMD;
2200         rval = qla2x00_mailbox_command(vha, mcp);
2201
2202         if (rval == QLA_SUCCESS) {
2203                 if (mcp->mb[0] != MBS_COMMAND_COMPLETE) {
2204                         DEBUG2_3_11(printk("%s(%ld): cmd failed. mbx0=%x.\n",
2205                             __func__, vha->host_no, mcp->mb[0]));
2206                         rval = QLA_FUNCTION_FAILED;
2207                 } else {
2208                         /* Copy over data -- firmware data is LE. */
2209                         dwords = sizeof(struct link_statistics) / 4;
2210                         siter = diter = &stats->link_fail_cnt;
2211                         while (dwords--)
2212                                 *diter++ = le32_to_cpu(*siter++);
2213                 }
2214         } else {
2215                 /* Failed. */
2216                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n", __func__,
2217                     vha->host_no, rval));
2218         }
2219
2220         return rval;
2221 }
2222
2223 int
2224 qla24xx_abort_command(srb_t *sp)
2225 {
2226         int             rval;
2227         unsigned long   flags = 0;
2228
2229         struct abort_entry_24xx *abt;
2230         dma_addr_t      abt_dma;
2231         uint32_t        handle;
2232         fc_port_t       *fcport = sp->fcport;
2233         struct scsi_qla_host *vha = fcport->vha;
2234         struct qla_hw_data *ha = vha->hw;
2235         struct req_que *req = vha->req;
2236
2237         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2238
2239         spin_lock_irqsave(&ha->hardware_lock, flags);
2240         for (handle = 1; handle < MAX_OUTSTANDING_COMMANDS; handle++) {
2241                 if (req->outstanding_cmds[handle] == sp)
2242                         break;
2243         }
2244         spin_unlock_irqrestore(&ha->hardware_lock, flags);
2245         if (handle == MAX_OUTSTANDING_COMMANDS) {
2246                 /* Command not found. */
2247                 return QLA_FUNCTION_FAILED;
2248         }
2249
2250         abt = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &abt_dma);
2251         if (abt == NULL) {
2252                 DEBUG2_3(printk("%s(%ld): failed to allocate Abort IOCB.\n",
2253                     __func__, vha->host_no));
2254                 return QLA_MEMORY_ALLOC_FAILED;
2255         }
2256         memset(abt, 0, sizeof(struct abort_entry_24xx));
2257
2258         abt->entry_type = ABORT_IOCB_TYPE;
2259         abt->entry_count = 1;
2260         abt->handle = MAKE_HANDLE(req->id, abt->handle);
2261         abt->nport_handle = cpu_to_le16(fcport->loop_id);
2262         abt->handle_to_abort = handle;
2263         abt->port_id[0] = fcport->d_id.b.al_pa;
2264         abt->port_id[1] = fcport->d_id.b.area;
2265         abt->port_id[2] = fcport->d_id.b.domain;
2266         abt->vp_index = fcport->vp_idx;
2267
2268         abt->req_que_no = cpu_to_le16(req->id);
2269
2270         rval = qla2x00_issue_iocb(vha, abt, abt_dma, 0);
2271         if (rval != QLA_SUCCESS) {
2272                 DEBUG2_3_11(printk("%s(%ld): failed to issue IOCB (%x).\n",
2273                     __func__, vha->host_no, rval));
2274         } else if (abt->entry_status != 0) {
2275                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
2276                     "-- error status (%x).\n", __func__, vha->host_no,
2277                     abt->entry_status));
2278                 rval = QLA_FUNCTION_FAILED;
2279         } else if (abt->nport_handle != __constant_cpu_to_le16(0)) {
2280                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
2281                     "-- completion status (%x).\n", __func__, vha->host_no,
2282                     le16_to_cpu(abt->nport_handle)));
2283                 rval = QLA_FUNCTION_FAILED;
2284         } else {
2285                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2286         }
2287
2288         dma_pool_free(ha->s_dma_pool, abt, abt_dma);
2289
2290         return rval;
2291 }
2292
2293 struct tsk_mgmt_cmd {
2294         union {
2295                 struct tsk_mgmt_entry tsk;
2296                 struct sts_entry_24xx sts;
2297         } p;
2298 };
2299
2300 static int
2301 __qla24xx_issue_tmf(char *name, uint32_t type, struct fc_port *fcport,
2302     unsigned int l, int tag)
2303 {
2304         int             rval, rval2;
2305         struct tsk_mgmt_cmd *tsk;
2306         dma_addr_t      tsk_dma;
2307         scsi_qla_host_t *vha;
2308         struct qla_hw_data *ha;
2309         struct req_que *req;
2310         struct rsp_que *rsp;
2311
2312         DEBUG11(printk("%s(%ld): entered.\n", __func__, fcport->vha->host_no));
2313
2314         vha = fcport->vha;
2315         ha = vha->hw;
2316         req = vha->req;
2317         if (ql2xmultique_tag)
2318                 rsp = ha->rsp_q_map[tag + 1];
2319         else
2320                 rsp = req->rsp;
2321         tsk = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &tsk_dma);
2322         if (tsk == NULL) {
2323                 DEBUG2_3(printk("%s(%ld): failed to allocate Task Management "
2324                     "IOCB.\n", __func__, vha->host_no));
2325                 return QLA_MEMORY_ALLOC_FAILED;
2326         }
2327         memset(tsk, 0, sizeof(struct tsk_mgmt_cmd));
2328
2329         tsk->p.tsk.entry_type = TSK_MGMT_IOCB_TYPE;
2330         tsk->p.tsk.entry_count = 1;
2331         tsk->p.tsk.handle = MAKE_HANDLE(req->id, tsk->p.tsk.handle);
2332         tsk->p.tsk.nport_handle = cpu_to_le16(fcport->loop_id);
2333         tsk->p.tsk.timeout = cpu_to_le16(ha->r_a_tov / 10 * 2);
2334         tsk->p.tsk.control_flags = cpu_to_le32(type);
2335         tsk->p.tsk.port_id[0] = fcport->d_id.b.al_pa;
2336         tsk->p.tsk.port_id[1] = fcport->d_id.b.area;
2337         tsk->p.tsk.port_id[2] = fcport->d_id.b.domain;
2338         tsk->p.tsk.vp_index = fcport->vp_idx;
2339         if (type == TCF_LUN_RESET) {
2340                 int_to_scsilun(l, &tsk->p.tsk.lun);
2341                 host_to_fcp_swap((uint8_t *)&tsk->p.tsk.lun,
2342                     sizeof(tsk->p.tsk.lun));
2343         }
2344
2345         rval = qla2x00_issue_iocb(vha, tsk, tsk_dma, 0);
2346         if (rval != QLA_SUCCESS) {
2347                 DEBUG2_3_11(printk("%s(%ld): failed to issue %s Reset IOCB "
2348                     "(%x).\n", __func__, vha->host_no, name, rval));
2349         } else if (tsk->p.sts.entry_status != 0) {
2350                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
2351                     "-- error status (%x).\n", __func__, vha->host_no,
2352                     tsk->p.sts.entry_status));
2353                 rval = QLA_FUNCTION_FAILED;
2354         } else if (tsk->p.sts.comp_status !=
2355             __constant_cpu_to_le16(CS_COMPLETE)) {
2356                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
2357                     "-- completion status (%x).\n", __func__,
2358                     vha->host_no, le16_to_cpu(tsk->p.sts.comp_status)));
2359                 rval = QLA_FUNCTION_FAILED;
2360         }
2361
2362         /* Issue marker IOCB. */
2363         rval2 = qla2x00_marker(vha, req, rsp, fcport->loop_id, l,
2364             type == TCF_LUN_RESET ? MK_SYNC_ID_LUN: MK_SYNC_ID);
2365         if (rval2 != QLA_SUCCESS) {
2366                 DEBUG2_3_11(printk("%s(%ld): failed to issue Marker IOCB "
2367                     "(%x).\n", __func__, vha->host_no, rval2));
2368         } else {
2369                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2370         }
2371
2372         dma_pool_free(ha->s_dma_pool, tsk, tsk_dma);
2373
2374         return rval;
2375 }
2376
2377 int
2378 qla24xx_abort_target(struct fc_port *fcport, unsigned int l, int tag)
2379 {
2380         return __qla24xx_issue_tmf("Target", TCF_TARGET_RESET, fcport, l, tag);
2381 }
2382
2383 int
2384 qla24xx_lun_reset(struct fc_port *fcport, unsigned int l, int tag)
2385 {
2386         return __qla24xx_issue_tmf("Lun", TCF_LUN_RESET, fcport, l, tag);
2387 }
2388
2389 int
2390 qla2x00_system_error(scsi_qla_host_t *vha)
2391 {
2392         int rval;
2393         mbx_cmd_t mc;
2394         mbx_cmd_t *mcp = &mc;
2395         struct qla_hw_data *ha = vha->hw;
2396
2397         if (!IS_QLA23XX(ha) && !IS_FWI2_CAPABLE(ha))
2398                 return QLA_FUNCTION_FAILED;
2399
2400         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2401
2402         mcp->mb[0] = MBC_GEN_SYSTEM_ERROR;
2403         mcp->out_mb = MBX_0;
2404         mcp->in_mb = MBX_0;
2405         mcp->tov = 5;
2406         mcp->flags = 0;
2407         rval = qla2x00_mailbox_command(vha, mcp);
2408
2409         if (rval != QLA_SUCCESS) {
2410                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n", __func__,
2411                     vha->host_no, rval));
2412         } else {
2413                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2414         }
2415
2416         return rval;
2417 }
2418
2419 /**
2420  * qla2x00_set_serdes_params() -
2421  * @ha: HA context
2422  *
2423  * Returns
2424  */
2425 int
2426 qla2x00_set_serdes_params(scsi_qla_host_t *vha, uint16_t sw_em_1g,
2427     uint16_t sw_em_2g, uint16_t sw_em_4g)
2428 {
2429         int rval;
2430         mbx_cmd_t mc;
2431         mbx_cmd_t *mcp = &mc;
2432
2433         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2434
2435         mcp->mb[0] = MBC_SERDES_PARAMS;
2436         mcp->mb[1] = BIT_0;
2437         mcp->mb[2] = sw_em_1g | BIT_15;
2438         mcp->mb[3] = sw_em_2g | BIT_15;
2439         mcp->mb[4] = sw_em_4g | BIT_15;
2440         mcp->out_mb = MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
2441         mcp->in_mb = MBX_0;
2442         mcp->tov = MBX_TOV_SECONDS;
2443         mcp->flags = 0;
2444         rval = qla2x00_mailbox_command(vha, mcp);
2445
2446         if (rval != QLA_SUCCESS) {
2447                 /*EMPTY*/
2448                 DEBUG2_3_11(printk("%s(%ld): failed=%x (%x).\n", __func__,
2449                     vha->host_no, rval, mcp->mb[0]));
2450         } else {
2451                 /*EMPTY*/
2452                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2453         }
2454
2455         return rval;
2456 }
2457
2458 int
2459 qla2x00_stop_firmware(scsi_qla_host_t *vha)
2460 {
2461         int rval;
2462         mbx_cmd_t mc;
2463         mbx_cmd_t *mcp = &mc;
2464
2465         if (!IS_FWI2_CAPABLE(vha->hw))
2466                 return QLA_FUNCTION_FAILED;
2467
2468         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2469
2470         mcp->mb[0] = MBC_STOP_FIRMWARE;
2471         mcp->out_mb = MBX_0;
2472         mcp->in_mb = MBX_0;
2473         mcp->tov = 5;
2474         mcp->flags = 0;
2475         rval = qla2x00_mailbox_command(vha, mcp);
2476
2477         if (rval != QLA_SUCCESS) {
2478                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n", __func__,
2479                     vha->host_no, rval));
2480                 if (mcp->mb[0] == MBS_INVALID_COMMAND)
2481                         rval = QLA_INVALID_COMMAND;
2482         } else {
2483                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2484         }
2485
2486         return rval;
2487 }
2488
2489 int
2490 qla2x00_enable_eft_trace(scsi_qla_host_t *vha, dma_addr_t eft_dma,
2491     uint16_t buffers)
2492 {
2493         int rval;
2494         mbx_cmd_t mc;
2495         mbx_cmd_t *mcp = &mc;
2496
2497         if (!IS_FWI2_CAPABLE(vha->hw))
2498                 return QLA_FUNCTION_FAILED;
2499
2500         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2501
2502         mcp->mb[0] = MBC_TRACE_CONTROL;
2503         mcp->mb[1] = TC_EFT_ENABLE;
2504         mcp->mb[2] = LSW(eft_dma);
2505         mcp->mb[3] = MSW(eft_dma);
2506         mcp->mb[4] = LSW(MSD(eft_dma));
2507         mcp->mb[5] = MSW(MSD(eft_dma));
2508         mcp->mb[6] = buffers;
2509         mcp->mb[7] = TC_AEN_DISABLE;
2510         mcp->out_mb = MBX_7|MBX_6|MBX_5|MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
2511         mcp->in_mb = MBX_1|MBX_0;
2512         mcp->tov = MBX_TOV_SECONDS;
2513         mcp->flags = 0;
2514         rval = qla2x00_mailbox_command(vha, mcp);
2515         if (rval != QLA_SUCCESS) {
2516                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x mb[1]=%x.\n",
2517                     __func__, vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
2518         } else {
2519                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2520         }
2521
2522         return rval;
2523 }
2524
2525 int
2526 qla2x00_disable_eft_trace(scsi_qla_host_t *vha)
2527 {
2528         int rval;
2529         mbx_cmd_t mc;
2530         mbx_cmd_t *mcp = &mc;
2531
2532         if (!IS_FWI2_CAPABLE(vha->hw))
2533                 return QLA_FUNCTION_FAILED;
2534
2535         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2536
2537         mcp->mb[0] = MBC_TRACE_CONTROL;
2538         mcp->mb[1] = TC_EFT_DISABLE;
2539         mcp->out_mb = MBX_1|MBX_0;
2540         mcp->in_mb = MBX_1|MBX_0;
2541         mcp->tov = MBX_TOV_SECONDS;
2542         mcp->flags = 0;
2543         rval = qla2x00_mailbox_command(vha, mcp);
2544         if (rval != QLA_SUCCESS) {
2545                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x mb[1]=%x.\n",
2546                     __func__, vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
2547         } else {
2548                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2549         }
2550
2551         return rval;
2552 }
2553
2554 int
2555 qla2x00_enable_fce_trace(scsi_qla_host_t *vha, dma_addr_t fce_dma,
2556     uint16_t buffers, uint16_t *mb, uint32_t *dwords)
2557 {
2558         int rval;
2559         mbx_cmd_t mc;
2560         mbx_cmd_t *mcp = &mc;
2561
2562         if (!IS_QLA25XX(vha->hw) && !IS_QLA81XX(vha->hw))
2563                 return QLA_FUNCTION_FAILED;
2564
2565         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2566
2567         mcp->mb[0] = MBC_TRACE_CONTROL;
2568         mcp->mb[1] = TC_FCE_ENABLE;
2569         mcp->mb[2] = LSW(fce_dma);
2570         mcp->mb[3] = MSW(fce_dma);
2571         mcp->mb[4] = LSW(MSD(fce_dma));
2572         mcp->mb[5] = MSW(MSD(fce_dma));
2573         mcp->mb[6] = buffers;
2574         mcp->mb[7] = TC_AEN_DISABLE;
2575         mcp->mb[8] = 0;
2576         mcp->mb[9] = TC_FCE_DEFAULT_RX_SIZE;
2577         mcp->mb[10] = TC_FCE_DEFAULT_TX_SIZE;
2578         mcp->out_mb = MBX_10|MBX_9|MBX_8|MBX_7|MBX_6|MBX_5|MBX_4|MBX_3|MBX_2|
2579             MBX_1|MBX_0;
2580         mcp->in_mb = MBX_6|MBX_5|MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
2581         mcp->tov = MBX_TOV_SECONDS;
2582         mcp->flags = 0;
2583         rval = qla2x00_mailbox_command(vha, mcp);
2584         if (rval != QLA_SUCCESS) {
2585                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x mb[1]=%x.\n",
2586                     __func__, vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
2587         } else {
2588                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2589
2590                 if (mb)
2591                         memcpy(mb, mcp->mb, 8 * sizeof(*mb));
2592                 if (dwords)
2593                         *dwords = buffers;
2594         }
2595
2596         return rval;
2597 }
2598
2599 int
2600 qla2x00_disable_fce_trace(scsi_qla_host_t *vha, uint64_t *wr, uint64_t *rd)
2601 {
2602         int rval;
2603         mbx_cmd_t mc;
2604         mbx_cmd_t *mcp = &mc;
2605
2606         if (!IS_FWI2_CAPABLE(vha->hw))
2607                 return QLA_FUNCTION_FAILED;
2608
2609         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2610
2611         mcp->mb[0] = MBC_TRACE_CONTROL;
2612         mcp->mb[1] = TC_FCE_DISABLE;
2613         mcp->mb[2] = TC_FCE_DISABLE_TRACE;
2614         mcp->out_mb = MBX_2|MBX_1|MBX_0;
2615         mcp->in_mb = MBX_9|MBX_8|MBX_7|MBX_6|MBX_5|MBX_4|MBX_3|MBX_2|
2616             MBX_1|MBX_0;
2617         mcp->tov = MBX_TOV_SECONDS;
2618         mcp->flags = 0;
2619         rval = qla2x00_mailbox_command(vha, mcp);
2620         if (rval != QLA_SUCCESS) {
2621                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x mb[1]=%x.\n",
2622                     __func__, vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
2623         } else {
2624                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2625
2626                 if (wr)
2627                         *wr = (uint64_t) mcp->mb[5] << 48 |
2628                             (uint64_t) mcp->mb[4] << 32 |
2629                             (uint64_t) mcp->mb[3] << 16 |
2630                             (uint64_t) mcp->mb[2];
2631                 if (rd)
2632                         *rd = (uint64_t) mcp->mb[9] << 48 |
2633                             (uint64_t) mcp->mb[8] << 32 |
2634                             (uint64_t) mcp->mb[7] << 16 |
2635                             (uint64_t) mcp->mb[6];
2636         }
2637
2638         return rval;
2639 }
2640
2641 int
2642 qla2x00_read_sfp(scsi_qla_host_t *vha, dma_addr_t sfp_dma, uint16_t addr,
2643     uint16_t off, uint16_t count)
2644 {
2645         int rval;
2646         mbx_cmd_t mc;
2647         mbx_cmd_t *mcp = &mc;
2648
2649         if (!IS_FWI2_CAPABLE(vha->hw))
2650                 return QLA_FUNCTION_FAILED;
2651
2652         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2653
2654         mcp->mb[0] = MBC_READ_SFP;
2655         mcp->mb[1] = addr;
2656         mcp->mb[2] = MSW(sfp_dma);
2657         mcp->mb[3] = LSW(sfp_dma);
2658         mcp->mb[6] = MSW(MSD(sfp_dma));
2659         mcp->mb[7] = LSW(MSD(sfp_dma));
2660         mcp->mb[8] = count;
2661         mcp->mb[9] = off;
2662         mcp->mb[10] = 0;
2663         mcp->out_mb = MBX_10|MBX_9|MBX_8|MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
2664         mcp->in_mb = MBX_0;
2665         mcp->tov = MBX_TOV_SECONDS;
2666         mcp->flags = 0;
2667         rval = qla2x00_mailbox_command(vha, mcp);
2668
2669         if (rval != QLA_SUCCESS) {
2670                 DEBUG2_3_11(printk("%s(%ld): failed=%x (%x).\n", __func__,
2671                     vha->host_no, rval, mcp->mb[0]));
2672         } else {
2673                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2674         }
2675
2676         return rval;
2677 }
2678
2679 int
2680 qla2x00_set_idma_speed(scsi_qla_host_t *vha, uint16_t loop_id,
2681     uint16_t port_speed, uint16_t *mb)
2682 {
2683         int rval;
2684         mbx_cmd_t mc;
2685         mbx_cmd_t *mcp = &mc;
2686
2687         if (!IS_IIDMA_CAPABLE(vha->hw))
2688                 return QLA_FUNCTION_FAILED;
2689
2690         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2691
2692         mcp->mb[0] = MBC_PORT_PARAMS;
2693         mcp->mb[1] = loop_id;
2694         mcp->mb[2] = BIT_0;
2695         mcp->mb[3] = port_speed & (BIT_2|BIT_1|BIT_0);
2696         mcp->mb[4] = mcp->mb[5] = 0;
2697         mcp->out_mb = MBX_5|MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
2698         mcp->in_mb = MBX_5|MBX_4|MBX_3|MBX_1|MBX_0;
2699         mcp->tov = MBX_TOV_SECONDS;
2700         mcp->flags = 0;
2701         rval = qla2x00_mailbox_command(vha, mcp);
2702
2703         /* Return mailbox statuses. */
2704         if (mb != NULL) {
2705                 mb[0] = mcp->mb[0];
2706                 mb[1] = mcp->mb[1];
2707                 mb[3] = mcp->mb[3];
2708                 mb[4] = mcp->mb[4];
2709                 mb[5] = mcp->mb[5];
2710         }
2711
2712         if (rval != QLA_SUCCESS) {
2713                 DEBUG2_3_11(printk("%s(%ld): failed=%x.\n", __func__,
2714                     vha->host_no, rval));
2715         } else {
2716                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
2717         }
2718
2719         return rval;
2720 }
2721
2722 void
2723 qla24xx_report_id_acquisition(scsi_qla_host_t *vha,
2724         struct vp_rpt_id_entry_24xx *rptid_entry)
2725 {
2726         uint8_t vp_idx;
2727         uint16_t stat = le16_to_cpu(rptid_entry->vp_idx);
2728         struct qla_hw_data *ha = vha->hw;
2729         scsi_qla_host_t *vp;
2730         scsi_qla_host_t *tvp;
2731
2732         if (rptid_entry->entry_status != 0)
2733                 return;
2734
2735         if (rptid_entry->format == 0) {
2736                 DEBUG15(printk("%s:format 0 : scsi(%ld) number of VPs setup %d,"
2737                         " number of VPs acquired %d\n", __func__, vha->host_no,
2738                         MSB(rptid_entry->vp_count), LSB(rptid_entry->vp_count)));
2739                 DEBUG15(printk("%s primary port id %02x%02x%02x\n", __func__,
2740                         rptid_entry->port_id[2], rptid_entry->port_id[1],
2741                         rptid_entry->port_id[0]));
2742         } else if (rptid_entry->format == 1) {
2743                 vp_idx = LSB(stat);
2744                 DEBUG15(printk("%s:format 1: scsi(%ld): VP[%d] enabled "
2745                     "- status %d - "
2746                     "with port id %02x%02x%02x\n", __func__, vha->host_no,
2747                     vp_idx, MSB(stat),
2748                     rptid_entry->port_id[2], rptid_entry->port_id[1],
2749                     rptid_entry->port_id[0]));
2750                 if (vp_idx == 0)
2751                         return;
2752
2753                 if (MSB(stat) == 1)
2754                         return;
2755
2756                 list_for_each_entry_safe(vp, tvp, &ha->vp_list, list)
2757                         if (vp_idx == vp->vp_idx)
2758                                 break;
2759                 if (!vp)
2760                         return;
2761
2762                 vp->d_id.b.domain = rptid_entry->port_id[2];
2763                 vp->d_id.b.area =  rptid_entry->port_id[1];
2764                 vp->d_id.b.al_pa = rptid_entry->port_id[0];
2765
2766                 /*
2767                  * Cannot configure here as we are still sitting on the
2768                  * response queue. Handle it in dpc context.
2769                  */
2770                 set_bit(VP_IDX_ACQUIRED, &vp->vp_flags);
2771                 set_bit(VP_DPC_NEEDED, &vha->dpc_flags);
2772
2773                 qla2xxx_wake_dpc(vha);
2774         }
2775 }
2776
2777 /*
2778  * qla24xx_modify_vp_config
2779  *      Change VP configuration for vha
2780  *
2781  * Input:
2782  *      vha = adapter block pointer.
2783  *
2784  * Returns:
2785  *      qla2xxx local function return status code.
2786  *
2787  * Context:
2788  *      Kernel context.
2789  */
2790 int
2791 qla24xx_modify_vp_config(scsi_qla_host_t *vha)
2792 {
2793         int             rval;
2794         struct vp_config_entry_24xx *vpmod;
2795         dma_addr_t      vpmod_dma;
2796         struct qla_hw_data *ha = vha->hw;
2797         struct scsi_qla_host *base_vha = pci_get_drvdata(ha->pdev);
2798
2799         /* This can be called by the parent */
2800
2801         vpmod = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &vpmod_dma);
2802         if (!vpmod) {
2803                 DEBUG2_3(printk("%s(%ld): failed to allocate Modify VP "
2804                     "IOCB.\n", __func__, vha->host_no));
2805                 return QLA_MEMORY_ALLOC_FAILED;
2806         }
2807
2808         memset(vpmod, 0, sizeof(struct vp_config_entry_24xx));
2809         vpmod->entry_type = VP_CONFIG_IOCB_TYPE;
2810         vpmod->entry_count = 1;
2811         vpmod->command = VCT_COMMAND_MOD_ENABLE_VPS;
2812         vpmod->vp_count = 1;
2813         vpmod->vp_index1 = vha->vp_idx;
2814         vpmod->options_idx1 = BIT_3|BIT_4|BIT_5;
2815         memcpy(vpmod->node_name_idx1, vha->node_name, WWN_SIZE);
2816         memcpy(vpmod->port_name_idx1, vha->port_name, WWN_SIZE);
2817         vpmod->entry_count = 1;
2818
2819         rval = qla2x00_issue_iocb(base_vha, vpmod, vpmod_dma, 0);
2820         if (rval != QLA_SUCCESS) {
2821                 DEBUG2_3_11(printk("%s(%ld): failed to issue VP config IOCB"
2822                         "(%x).\n", __func__, base_vha->host_no, rval));
2823         } else if (vpmod->comp_status != 0) {
2824                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
2825                         "-- error status (%x).\n", __func__, base_vha->host_no,
2826                         vpmod->comp_status));
2827                 rval = QLA_FUNCTION_FAILED;
2828         } else if (vpmod->comp_status != __constant_cpu_to_le16(CS_COMPLETE)) {
2829                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
2830                     "-- completion status (%x).\n", __func__, base_vha->host_no,
2831                     le16_to_cpu(vpmod->comp_status)));
2832                 rval = QLA_FUNCTION_FAILED;
2833         } else {
2834                 /* EMPTY */
2835                 DEBUG11(printk("%s(%ld): done.\n", __func__,
2836                                                         base_vha->host_no));
2837                 fc_vport_set_state(vha->fc_vport, FC_VPORT_INITIALIZING);
2838         }
2839         dma_pool_free(ha->s_dma_pool, vpmod, vpmod_dma);
2840
2841         return rval;
2842 }
2843
2844 /*
2845  * qla24xx_control_vp
2846  *      Enable a virtual port for given host
2847  *
2848  * Input:
2849  *      ha = adapter block pointer.
2850  *      vhba = virtual adapter (unused)
2851  *      index = index number for enabled VP
2852  *
2853  * Returns:
2854  *      qla2xxx local function return status code.
2855  *
2856  * Context:
2857  *      Kernel context.
2858  */
2859 int
2860 qla24xx_control_vp(scsi_qla_host_t *vha, int cmd)
2861 {
2862         int             rval;
2863         int             map, pos;
2864         struct vp_ctrl_entry_24xx   *vce;
2865         dma_addr_t      vce_dma;
2866         struct qla_hw_data *ha = vha->hw;
2867         int     vp_index = vha->vp_idx;
2868         struct scsi_qla_host *base_vha = pci_get_drvdata(ha->pdev);
2869
2870         DEBUG11(printk("%s(%ld): entered. Enabling index %d\n", __func__,
2871             vha->host_no, vp_index));
2872
2873         if (vp_index == 0 || vp_index >= ha->max_npiv_vports)
2874                 return QLA_PARAMETER_ERROR;
2875
2876         vce = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &vce_dma);
2877         if (!vce) {
2878                 DEBUG2_3(printk("%s(%ld): "
2879                     "failed to allocate VP Control IOCB.\n", __func__,
2880                     base_vha->host_no));
2881                 return QLA_MEMORY_ALLOC_FAILED;
2882         }
2883         memset(vce, 0, sizeof(struct vp_ctrl_entry_24xx));
2884
2885         vce->entry_type = VP_CTRL_IOCB_TYPE;
2886         vce->entry_count = 1;
2887         vce->command = cpu_to_le16(cmd);
2888         vce->vp_count = __constant_cpu_to_le16(1);
2889
2890         /* index map in firmware starts with 1; decrement index
2891          * this is ok as we never use index 0
2892          */
2893         map = (vp_index - 1) / 8;
2894         pos = (vp_index - 1) & 7;
2895         mutex_lock(&ha->vport_lock);
2896         vce->vp_idx_map[map] |= 1 << pos;
2897         mutex_unlock(&ha->vport_lock);
2898
2899         rval = qla2x00_issue_iocb(base_vha, vce, vce_dma, 0);
2900         if (rval != QLA_SUCCESS) {
2901                 DEBUG2_3_11(printk("%s(%ld): failed to issue VP control IOCB"
2902                     "(%x).\n", __func__, base_vha->host_no, rval));
2903                 printk("%s(%ld): failed to issue VP control IOCB"
2904                     "(%x).\n", __func__, base_vha->host_no, rval);
2905         } else if (vce->entry_status != 0) {
2906                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
2907                     "-- error status (%x).\n", __func__, base_vha->host_no,
2908                     vce->entry_status));
2909                 printk("%s(%ld): failed to complete IOCB "
2910                     "-- error status (%x).\n", __func__, base_vha->host_no,
2911                     vce->entry_status);
2912                 rval = QLA_FUNCTION_FAILED;
2913         } else if (vce->comp_status != __constant_cpu_to_le16(CS_COMPLETE)) {
2914                 DEBUG2_3_11(printk("%s(%ld): failed to complete IOCB "
2915                     "-- completion status (%x).\n", __func__, base_vha->host_no,
2916                     le16_to_cpu(vce->comp_status)));
2917                 printk("%s(%ld): failed to complete IOCB "
2918                     "-- completion status (%x).\n", __func__, base_vha->host_no,
2919                     le16_to_cpu(vce->comp_status));
2920                 rval = QLA_FUNCTION_FAILED;
2921         } else {
2922                 DEBUG2(printk("%s(%ld): done.\n", __func__, base_vha->host_no));
2923         }
2924
2925         dma_pool_free(ha->s_dma_pool, vce, vce_dma);
2926
2927         return rval;
2928 }
2929
2930 /*
2931  * qla2x00_send_change_request
2932  *      Receive or disable RSCN request from fabric controller
2933  *
2934  * Input:
2935  *      ha = adapter block pointer
2936  *      format = registration format:
2937  *              0 - Reserved
2938  *              1 - Fabric detected registration
2939  *              2 - N_port detected registration
2940  *              3 - Full registration
2941  *              FF - clear registration
2942  *      vp_idx = Virtual port index
2943  *
2944  * Returns:
2945  *      qla2x00 local function return status code.
2946  *
2947  * Context:
2948  *      Kernel Context
2949  */
2950
2951 int
2952 qla2x00_send_change_request(scsi_qla_host_t *vha, uint16_t format,
2953                             uint16_t vp_idx)
2954 {
2955         int rval;
2956         mbx_cmd_t mc;
2957         mbx_cmd_t *mcp = &mc;
2958
2959         /*
2960          * This command is implicitly executed by firmware during login for the
2961          * physical hosts
2962          */
2963         if (vp_idx == 0)
2964                 return QLA_FUNCTION_FAILED;
2965
2966         mcp->mb[0] = MBC_SEND_CHANGE_REQUEST;
2967         mcp->mb[1] = format;
2968         mcp->mb[9] = vp_idx;
2969         mcp->out_mb = MBX_9|MBX_1|MBX_0;
2970         mcp->in_mb = MBX_0|MBX_1;
2971         mcp->tov = MBX_TOV_SECONDS;
2972         mcp->flags = 0;
2973         rval = qla2x00_mailbox_command(vha, mcp);
2974
2975         if (rval == QLA_SUCCESS) {
2976                 if (mcp->mb[0] != MBS_COMMAND_COMPLETE) {
2977                         rval = BIT_1;
2978                 }
2979         } else
2980                 rval = BIT_1;
2981
2982         return rval;
2983 }
2984
2985 int
2986 qla2x00_dump_ram(scsi_qla_host_t *vha, dma_addr_t req_dma, uint32_t addr,
2987     uint32_t size)
2988 {
2989         int rval;
2990         mbx_cmd_t mc;
2991         mbx_cmd_t *mcp = &mc;
2992
2993         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
2994
2995         if (MSW(addr) || IS_FWI2_CAPABLE(vha->hw)) {
2996                 mcp->mb[0] = MBC_DUMP_RISC_RAM_EXTENDED;
2997                 mcp->mb[8] = MSW(addr);
2998                 mcp->out_mb = MBX_8|MBX_0;
2999         } else {
3000                 mcp->mb[0] = MBC_DUMP_RISC_RAM;
3001                 mcp->out_mb = MBX_0;
3002         }
3003         mcp->mb[1] = LSW(addr);
3004         mcp->mb[2] = MSW(req_dma);
3005         mcp->mb[3] = LSW(req_dma);
3006         mcp->mb[6] = MSW(MSD(req_dma));
3007         mcp->mb[7] = LSW(MSD(req_dma));
3008         mcp->out_mb |= MBX_7|MBX_6|MBX_3|MBX_2|MBX_1;
3009         if (IS_FWI2_CAPABLE(vha->hw)) {
3010                 mcp->mb[4] = MSW(size);
3011                 mcp->mb[5] = LSW(size);
3012                 mcp->out_mb |= MBX_5|MBX_4;
3013         } else {
3014                 mcp->mb[4] = LSW(size);
3015                 mcp->out_mb |= MBX_4;
3016         }
3017
3018         mcp->in_mb = MBX_0;
3019         mcp->tov = MBX_TOV_SECONDS;
3020         mcp->flags = 0;
3021         rval = qla2x00_mailbox_command(vha, mcp);
3022
3023         if (rval != QLA_SUCCESS) {
3024                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x.\n", __func__,
3025                     vha->host_no, rval, mcp->mb[0]));
3026         } else {
3027                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
3028         }
3029
3030         return rval;
3031 }
3032
3033 /* 84XX Support **************************************************************/
3034
3035 struct cs84xx_mgmt_cmd {
3036         union {
3037                 struct verify_chip_entry_84xx req;
3038                 struct verify_chip_rsp_84xx rsp;
3039         } p;
3040 };
3041
3042 int
3043 qla84xx_verify_chip(struct scsi_qla_host *vha, uint16_t *status)
3044 {
3045         int rval, retry;
3046         struct cs84xx_mgmt_cmd *mn;
3047         dma_addr_t mn_dma;
3048         uint16_t options;
3049         unsigned long flags;
3050         struct qla_hw_data *ha = vha->hw;
3051
3052         DEBUG16(printk("%s(%ld): entered.\n", __func__, vha->host_no));
3053
3054         mn = dma_pool_alloc(ha->s_dma_pool, GFP_KERNEL, &mn_dma);
3055         if (mn == NULL) {
3056                 DEBUG2_3(printk("%s(%ld): failed to allocate Verify ISP84XX "
3057                     "IOCB.\n", __func__, vha->host_no));
3058                 return QLA_MEMORY_ALLOC_FAILED;
3059         }
3060
3061         /* Force Update? */
3062         options = ha->cs84xx->fw_update ? VCO_FORCE_UPDATE : 0;
3063         /* Diagnostic firmware? */
3064         /* options |= MENLO_DIAG_FW; */
3065         /* We update the firmware with only one data sequence. */
3066         options |= VCO_END_OF_DATA;
3067
3068         do {
3069                 retry = 0;
3070                 memset(mn, 0, sizeof(*mn));
3071                 mn->p.req.entry_type = VERIFY_CHIP_IOCB_TYPE;
3072                 mn->p.req.entry_count = 1;
3073                 mn->p.req.options = cpu_to_le16(options);
3074
3075                 DEBUG16(printk("%s(%ld): Dump of Verify Request.\n", __func__,
3076                     vha->host_no));
3077                 DEBUG16(qla2x00_dump_buffer((uint8_t *)mn,
3078                     sizeof(*mn)));
3079
3080                 rval = qla2x00_issue_iocb_timeout(vha, mn, mn_dma, 0, 120);
3081                 if (rval != QLA_SUCCESS) {
3082                         DEBUG2_16(printk("%s(%ld): failed to issue Verify "
3083                             "IOCB (%x).\n", __func__, vha->host_no, rval));
3084                         goto verify_done;
3085                 }
3086
3087                 DEBUG16(printk("%s(%ld): Dump of Verify Response.\n", __func__,
3088                     vha->host_no));
3089                 DEBUG16(qla2x00_dump_buffer((uint8_t *)mn,
3090                     sizeof(*mn)));
3091
3092                 status[0] = le16_to_cpu(mn->p.rsp.comp_status);
3093                 status[1] = status[0] == CS_VCS_CHIP_FAILURE ?
3094                     le16_to_cpu(mn->p.rsp.failure_code) : 0;
3095                 DEBUG2_16(printk("%s(%ld): cs=%x fc=%x\n", __func__,
3096                     vha->host_no, status[0], status[1]));
3097
3098                 if (status[0] != CS_COMPLETE) {
3099                         rval = QLA_FUNCTION_FAILED;
3100                         if (!(options & VCO_DONT_UPDATE_FW)) {
3101                                 DEBUG2_16(printk("%s(%ld): Firmware update "
3102                                     "failed. Retrying without update "
3103                                     "firmware.\n", __func__, vha->host_no));
3104                                 options |= VCO_DONT_UPDATE_FW;
3105                                 options &= ~VCO_FORCE_UPDATE;
3106                                 retry = 1;
3107                         }
3108                 } else {
3109                         DEBUG2_16(printk("%s(%ld): firmware updated to %x.\n",
3110                             __func__, vha->host_no,
3111                             le32_to_cpu(mn->p.rsp.fw_ver)));
3112
3113                         /* NOTE: we only update OP firmware. */
3114                         spin_lock_irqsave(&ha->cs84xx->access_lock, flags);
3115                         ha->cs84xx->op_fw_version =
3116                             le32_to_cpu(mn->p.rsp.fw_ver);
3117                         spin_unlock_irqrestore(&ha->cs84xx->access_lock,
3118                             flags);
3119                 }
3120         } while (retry);
3121
3122 verify_done:
3123         dma_pool_free(ha->s_dma_pool, mn, mn_dma);
3124
3125         if (rval != QLA_SUCCESS) {
3126                 DEBUG2_16(printk("%s(%ld): failed=%x.\n", __func__,
3127                     vha->host_no, rval));
3128         } else {
3129                 DEBUG16(printk("%s(%ld): done.\n", __func__, vha->host_no));
3130         }
3131
3132         return rval;
3133 }
3134
3135 int
3136 qla25xx_init_req_que(struct scsi_qla_host *vha, struct req_que *req)
3137 {
3138         int rval;
3139         unsigned long flags;
3140         mbx_cmd_t mc;
3141         mbx_cmd_t *mcp = &mc;
3142         struct device_reg_25xxmq __iomem *reg;
3143         struct qla_hw_data *ha = vha->hw;
3144
3145         mcp->mb[0] = MBC_INITIALIZE_MULTIQ;
3146         mcp->mb[1] = req->options;
3147         mcp->mb[2] = MSW(LSD(req->dma));
3148         mcp->mb[3] = LSW(LSD(req->dma));
3149         mcp->mb[6] = MSW(MSD(req->dma));
3150         mcp->mb[7] = LSW(MSD(req->dma));
3151         mcp->mb[5] = req->length;
3152         if (req->rsp)
3153                 mcp->mb[10] = req->rsp->id;
3154         mcp->mb[12] = req->qos;
3155         mcp->mb[11] = req->vp_idx;
3156         mcp->mb[13] = req->rid;
3157
3158         reg = (struct device_reg_25xxmq *)((void *)(ha->mqiobase) +
3159                 QLA_QUE_PAGE * req->id);
3160
3161         mcp->mb[4] = req->id;
3162         /* que in ptr index */
3163         mcp->mb[8] = 0;
3164         /* que out ptr index */
3165         mcp->mb[9] = 0;
3166         mcp->out_mb = MBX_14|MBX_13|MBX_12|MBX_11|MBX_10|MBX_9|MBX_8|MBX_7|
3167                         MBX_6|MBX_5|MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
3168         mcp->in_mb = MBX_0;
3169         mcp->flags = MBX_DMA_OUT;
3170         mcp->tov = 60;
3171
3172         spin_lock_irqsave(&ha->hardware_lock, flags);
3173         if (!(req->options & BIT_0)) {
3174                 WRT_REG_DWORD(&reg->req_q_in, 0);
3175                 WRT_REG_DWORD(&reg->req_q_out, 0);
3176         }
3177         req->req_q_in = &reg->req_q_in;
3178         req->req_q_out = &reg->req_q_out;
3179         spin_unlock_irqrestore(&ha->hardware_lock, flags);
3180
3181         rval = qla2x00_mailbox_command(vha, mcp);
3182         if (rval != QLA_SUCCESS)
3183                 DEBUG2_3_11(printk(KERN_WARNING "%s(%ld): failed=%x mb0=%x.\n",
3184                         __func__, vha->host_no, rval, mcp->mb[0]));
3185         return rval;
3186 }
3187
3188 int
3189 qla25xx_init_rsp_que(struct scsi_qla_host *vha, struct rsp_que *rsp)
3190 {
3191         int rval;
3192         unsigned long flags;
3193         mbx_cmd_t mc;
3194         mbx_cmd_t *mcp = &mc;
3195         struct device_reg_25xxmq __iomem *reg;
3196         struct qla_hw_data *ha = vha->hw;
3197
3198         mcp->mb[0] = MBC_INITIALIZE_MULTIQ;
3199         mcp->mb[1] = rsp->options;
3200         mcp->mb[2] = MSW(LSD(rsp->dma));
3201         mcp->mb[3] = LSW(LSD(rsp->dma));
3202         mcp->mb[6] = MSW(MSD(rsp->dma));
3203         mcp->mb[7] = LSW(MSD(rsp->dma));
3204         mcp->mb[5] = rsp->length;
3205         mcp->mb[14] = rsp->msix->entry;
3206         mcp->mb[13] = rsp->rid;
3207
3208         reg = (struct device_reg_25xxmq *)((void *)(ha->mqiobase) +
3209                 QLA_QUE_PAGE * rsp->id);
3210
3211         mcp->mb[4] = rsp->id;
3212         /* que in ptr index */
3213         mcp->mb[8] = 0;
3214         /* que out ptr index */
3215         mcp->mb[9] = 0;
3216         mcp->out_mb = MBX_14|MBX_13|MBX_9|MBX_8|MBX_7
3217                         |MBX_6|MBX_5|MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
3218         mcp->in_mb = MBX_0;
3219         mcp->flags = MBX_DMA_OUT;
3220         mcp->tov = 60;
3221
3222         spin_lock_irqsave(&ha->hardware_lock, flags);
3223         if (!(rsp->options & BIT_0)) {
3224                 WRT_REG_DWORD(&reg->rsp_q_out, 0);
3225                 WRT_REG_DWORD(&reg->rsp_q_in, 0);
3226         }
3227
3228         spin_unlock_irqrestore(&ha->hardware_lock, flags);
3229
3230         rval = qla2x00_mailbox_command(vha, mcp);
3231         if (rval != QLA_SUCCESS)
3232                 DEBUG2_3_11(printk(KERN_WARNING "%s(%ld): failed=%x "
3233                         "mb0=%x.\n", __func__,
3234                         vha->host_no, rval, mcp->mb[0]));
3235         return rval;
3236 }
3237
3238 int
3239 qla81xx_idc_ack(scsi_qla_host_t *vha, uint16_t *mb)
3240 {
3241         int rval;
3242         mbx_cmd_t mc;
3243         mbx_cmd_t *mcp = &mc;
3244
3245         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
3246
3247         mcp->mb[0] = MBC_IDC_ACK;
3248         memcpy(&mcp->mb[1], mb, QLA_IDC_ACK_REGS * sizeof(uint16_t));
3249         mcp->out_mb = MBX_7|MBX_6|MBX_5|MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
3250         mcp->in_mb = MBX_0;
3251         mcp->tov = MBX_TOV_SECONDS;
3252         mcp->flags = 0;
3253         rval = qla2x00_mailbox_command(vha, mcp);
3254
3255         if (rval != QLA_SUCCESS) {
3256                 DEBUG2_3_11(printk("%s(%ld): failed=%x (%x).\n", __func__,
3257                     vha->host_no, rval, mcp->mb[0]));
3258         } else {
3259                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
3260         }
3261
3262         return rval;
3263 }
3264
3265 int
3266 qla81xx_fac_get_sector_size(scsi_qla_host_t *vha, uint32_t *sector_size)
3267 {
3268         int rval;
3269         mbx_cmd_t mc;
3270         mbx_cmd_t *mcp = &mc;
3271
3272         if (!IS_QLA81XX(vha->hw))
3273                 return QLA_FUNCTION_FAILED;
3274
3275         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
3276
3277         mcp->mb[0] = MBC_FLASH_ACCESS_CTRL;
3278         mcp->mb[1] = FAC_OPT_CMD_GET_SECTOR_SIZE;
3279         mcp->out_mb = MBX_1|MBX_0;
3280         mcp->in_mb = MBX_1|MBX_0;
3281         mcp->tov = MBX_TOV_SECONDS;
3282         mcp->flags = 0;
3283         rval = qla2x00_mailbox_command(vha, mcp);
3284
3285         if (rval != QLA_SUCCESS) {
3286                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x mb[1]=%x.\n",
3287                     __func__, vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
3288         } else {
3289                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
3290                 *sector_size = mcp->mb[1];
3291         }
3292
3293         return rval;
3294 }
3295
3296 int
3297 qla81xx_fac_do_write_enable(scsi_qla_host_t *vha, int enable)
3298 {
3299         int rval;
3300         mbx_cmd_t mc;
3301         mbx_cmd_t *mcp = &mc;
3302
3303         if (!IS_QLA81XX(vha->hw))
3304                 return QLA_FUNCTION_FAILED;
3305
3306         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
3307
3308         mcp->mb[0] = MBC_FLASH_ACCESS_CTRL;
3309         mcp->mb[1] = enable ? FAC_OPT_CMD_WRITE_ENABLE :
3310             FAC_OPT_CMD_WRITE_PROTECT;
3311         mcp->out_mb = MBX_1|MBX_0;
3312         mcp->in_mb = MBX_1|MBX_0;
3313         mcp->tov = MBX_TOV_SECONDS;
3314         mcp->flags = 0;
3315         rval = qla2x00_mailbox_command(vha, mcp);
3316
3317         if (rval != QLA_SUCCESS) {
3318                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x mb[1]=%x.\n",
3319                     __func__, vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
3320         } else {
3321                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
3322         }
3323
3324         return rval;
3325 }
3326
3327 int
3328 qla81xx_fac_erase_sector(scsi_qla_host_t *vha, uint32_t start, uint32_t finish)
3329 {
3330         int rval;
3331         mbx_cmd_t mc;
3332         mbx_cmd_t *mcp = &mc;
3333
3334         if (!IS_QLA81XX(vha->hw))
3335                 return QLA_FUNCTION_FAILED;
3336
3337         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
3338
3339         mcp->mb[0] = MBC_FLASH_ACCESS_CTRL;
3340         mcp->mb[1] = FAC_OPT_CMD_ERASE_SECTOR;
3341         mcp->mb[2] = LSW(start);
3342         mcp->mb[3] = MSW(start);
3343         mcp->mb[4] = LSW(finish);
3344         mcp->mb[5] = MSW(finish);
3345         mcp->out_mb = MBX_5|MBX_4|MBX_3|MBX_2|MBX_1|MBX_0;
3346         mcp->in_mb = MBX_2|MBX_1|MBX_0;
3347         mcp->tov = MBX_TOV_SECONDS;
3348         mcp->flags = 0;
3349         rval = qla2x00_mailbox_command(vha, mcp);
3350
3351         if (rval != QLA_SUCCESS) {
3352                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=%x mb[1]=%x "
3353                     "mb[2]=%x.\n", __func__, vha->host_no, rval, mcp->mb[0],
3354                     mcp->mb[1], mcp->mb[2]));
3355         } else {
3356                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
3357         }
3358
3359         return rval;
3360 }
3361
3362 int
3363 qla81xx_restart_mpi_firmware(scsi_qla_host_t *vha)
3364 {
3365         int rval = 0;
3366         mbx_cmd_t mc;
3367         mbx_cmd_t *mcp = &mc;
3368
3369         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
3370
3371         mcp->mb[0] = MBC_RESTART_MPI_FW;
3372         mcp->out_mb = MBX_0;
3373         mcp->in_mb = MBX_0|MBX_1;
3374         mcp->tov = MBX_TOV_SECONDS;
3375         mcp->flags = 0;
3376         rval = qla2x00_mailbox_command(vha, mcp);
3377
3378         if (rval != QLA_SUCCESS) {
3379                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=0x%x mb[1]=0x%x.\n",
3380                     __func__, vha->host_no, rval, mcp->mb[0], mcp->mb[1]));
3381         } else {
3382                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
3383         }
3384
3385         return rval;
3386 }
3387
3388 int
3389 qla2x00_read_edc(scsi_qla_host_t *vha, uint16_t dev, uint16_t adr,
3390     dma_addr_t sfp_dma, uint8_t *sfp, uint16_t len, uint16_t opt)
3391 {
3392         int rval;
3393         mbx_cmd_t mc;
3394         mbx_cmd_t *mcp = &mc;
3395
3396         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
3397
3398         mcp->mb[0] = MBC_READ_SFP;
3399         mcp->mb[1] = dev;
3400         mcp->mb[2] = MSW(sfp_dma);
3401         mcp->mb[3] = LSW(sfp_dma);
3402         mcp->mb[6] = MSW(MSD(sfp_dma));
3403         mcp->mb[7] = LSW(MSD(sfp_dma));
3404         mcp->mb[8] = len;
3405         mcp->mb[9] = adr;
3406         mcp->mb[10] = opt;
3407         mcp->out_mb = MBX_10|MBX_9|MBX_8|MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
3408         mcp->in_mb = MBX_0;
3409         mcp->tov = MBX_TOV_SECONDS;
3410         mcp->flags = 0;
3411         rval = qla2x00_mailbox_command(vha, mcp);
3412
3413         if (opt & BIT_0)
3414                 if (sfp)
3415                         *sfp = mcp->mb[8];
3416
3417         if (rval != QLA_SUCCESS) {
3418                 DEBUG2_3_11(printk("%s(%ld): failed=%x (%x).\n", __func__,
3419                     vha->host_no, rval, mcp->mb[0]));
3420         } else {
3421                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
3422         }
3423
3424         return rval;
3425 }
3426
3427 int
3428 qla2x00_write_edc(scsi_qla_host_t *vha, uint16_t dev, uint16_t adr,
3429     dma_addr_t sfp_dma, uint8_t *sfp, uint16_t len, uint16_t opt)
3430 {
3431         int rval;
3432         mbx_cmd_t mc;
3433         mbx_cmd_t *mcp = &mc;
3434
3435         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
3436
3437         if (opt & BIT_0)
3438                 if (sfp)
3439                         len = *sfp;
3440
3441         mcp->mb[0] = MBC_WRITE_SFP;
3442         mcp->mb[1] = dev;
3443         mcp->mb[2] = MSW(sfp_dma);
3444         mcp->mb[3] = LSW(sfp_dma);
3445         mcp->mb[6] = MSW(MSD(sfp_dma));
3446         mcp->mb[7] = LSW(MSD(sfp_dma));
3447         mcp->mb[8] = len;
3448         mcp->mb[9] = adr;
3449         mcp->mb[10] = opt;
3450         mcp->out_mb = MBX_10|MBX_9|MBX_8|MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
3451         mcp->in_mb = MBX_0;
3452         mcp->tov = MBX_TOV_SECONDS;
3453         mcp->flags = 0;
3454         rval = qla2x00_mailbox_command(vha, mcp);
3455
3456         if (rval != QLA_SUCCESS) {
3457                 DEBUG2_3_11(printk("%s(%ld): failed=%x (%x).\n", __func__,
3458                     vha->host_no, rval, mcp->mb[0]));
3459         } else {
3460                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
3461         }
3462
3463         return rval;
3464 }
3465
3466 int
3467 qla2x00_get_xgmac_stats(scsi_qla_host_t *vha, dma_addr_t stats_dma,
3468     uint16_t size_in_bytes, uint16_t *actual_size)
3469 {
3470         int rval;
3471         mbx_cmd_t mc;
3472         mbx_cmd_t *mcp = &mc;
3473
3474         if (!IS_QLA81XX(vha->hw))
3475                 return QLA_FUNCTION_FAILED;
3476
3477         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
3478
3479         mcp->mb[0] = MBC_GET_XGMAC_STATS;
3480         mcp->mb[2] = MSW(stats_dma);
3481         mcp->mb[3] = LSW(stats_dma);
3482         mcp->mb[6] = MSW(MSD(stats_dma));
3483         mcp->mb[7] = LSW(MSD(stats_dma));
3484         mcp->mb[8] = size_in_bytes >> 2;
3485         mcp->out_mb = MBX_8|MBX_7|MBX_6|MBX_3|MBX_2|MBX_0;
3486         mcp->in_mb = MBX_2|MBX_1|MBX_0;
3487         mcp->tov = MBX_TOV_SECONDS;
3488         mcp->flags = 0;
3489         rval = qla2x00_mailbox_command(vha, mcp);
3490
3491         if (rval != QLA_SUCCESS) {
3492                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=0x%x "
3493                     "mb[1]=0x%x mb[2]=0x%x.\n", __func__, vha->host_no, rval,
3494                     mcp->mb[0], mcp->mb[1], mcp->mb[2]));
3495         } else {
3496                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
3497
3498                 *actual_size = mcp->mb[2] << 2;
3499         }
3500
3501         return rval;
3502 }
3503
3504 int
3505 qla2x00_get_dcbx_params(scsi_qla_host_t *vha, dma_addr_t tlv_dma,
3506     uint16_t size)
3507 {
3508         int rval;
3509         mbx_cmd_t mc;
3510         mbx_cmd_t *mcp = &mc;
3511
3512         if (!IS_QLA81XX(vha->hw))
3513                 return QLA_FUNCTION_FAILED;
3514
3515         DEBUG11(printk("%s(%ld): entered.\n", __func__, vha->host_no));
3516
3517         mcp->mb[0] = MBC_GET_DCBX_PARAMS;
3518         mcp->mb[1] = 0;
3519         mcp->mb[2] = MSW(tlv_dma);
3520         mcp->mb[3] = LSW(tlv_dma);
3521         mcp->mb[6] = MSW(MSD(tlv_dma));
3522         mcp->mb[7] = LSW(MSD(tlv_dma));
3523         mcp->mb[8] = size;
3524         mcp->out_mb = MBX_8|MBX_7|MBX_6|MBX_3|MBX_2|MBX_1|MBX_0;
3525         mcp->in_mb = MBX_2|MBX_1|MBX_0;
3526         mcp->tov = MBX_TOV_SECONDS;
3527         mcp->flags = 0;
3528         rval = qla2x00_mailbox_command(vha, mcp);
3529
3530         if (rval != QLA_SUCCESS) {
3531                 DEBUG2_3_11(printk("%s(%ld): failed=%x mb[0]=0x%x "
3532                     "mb[1]=0x%x mb[2]=0x%x.\n", __func__, vha->host_no, rval,
3533                     mcp->mb[0], mcp->mb[1], mcp->mb[2]));
3534         } else {
3535                 DEBUG11(printk("%s(%ld): done.\n", __func__, vha->host_no));
3536         }
3537
3538         return rval;
3539 }