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