drivers/scsi/qla2xxx/qla_mbx.c

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