git.oblomov.eu Git - linux-2.6/blob - drivers/scsi/qla2xxx/qla_isr.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 #include <scsi/scsi_tcq.h>
  11
  12 static void qla2x00_mbx_completion(scsi_qla_host_t *, uint16_t);
  13 static void qla2x00_process_completed_request(struct scsi_qla_host *, uint32_t);
  14 static void qla2x00_status_entry(scsi_qla_host_t *, void *);
  15 static void qla2x00_status_cont_entry(scsi_qla_host_t *, sts_cont_entry_t *);
  16 static void qla2x00_error_entry(scsi_qla_host_t *, sts_entry_t *);
  17 static void qla2x00_ms_entry(scsi_qla_host_t *, ms_iocb_entry_t *);
  18
  19 static void qla24xx_ms_entry(scsi_qla_host_t *, struct ct_entry_24xx *);
  20
  21 /**
  22  * qla2100_intr_handler() - Process interrupts for the ISP2100 and ISP2200.
  23  * @irq:
  24  * @dev_id: SCSI driver HA context
  25  *
  26  * Called by system whenever the host adapter generates an interrupt.
  27  *
  28  * Returns handled flag.
  29  */
  30 irqreturn_t
  31 qla2100_intr_handler(int irq, void *dev_id)
  32 {
  33         scsi_qla_host_t *ha;
  34         struct device_reg_2xxx __iomem *reg;
  35         int             status;
  36         unsigned long   flags;
  37         unsigned long   iter;
  38         uint16_t        hccr;
  39         uint16_t        mb[4];
  40
  41         ha = (scsi_qla_host_t *) dev_id;
  42         if (!ha) {
  43                 printk(KERN_INFO
  44                     "%s(): NULL host pointer\n", __func__);
  45                 return (IRQ_NONE);
  46         }
  47
  48         reg = &ha->iobase->isp;
  49         status = 0;
  50
  51         spin_lock_irqsave(&ha->hardware_lock, flags);
  52         for (iter = 50; iter--; ) {
  53                 hccr = RD_REG_WORD(&reg->hccr);
  54                 if (hccr & HCCR_RISC_PAUSE) {
  55                         if (pci_channel_offline(ha->pdev))
  56                                 break;
  57
  58                         /*
  59                          * Issue a "HARD" reset in order for the RISC interrupt
  60                          * bit to be cleared.  Schedule a big hammmer to get
  61                          * out of the RISC PAUSED state.
  62                          */
  63                         WRT_REG_WORD(&reg->hccr, HCCR_RESET_RISC);
  64                         RD_REG_WORD(&reg->hccr);
  65
  66                         ha->isp_ops->fw_dump(ha, 1);
  67                         set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
  68                         break;
  69                 } else if ((RD_REG_WORD(&reg->istatus) & ISR_RISC_INT) == 0)
  70                         break;
  71
  72                 if (RD_REG_WORD(&reg->semaphore) & BIT_0) {
  73                         WRT_REG_WORD(&reg->hccr, HCCR_CLR_RISC_INT);
  74                         RD_REG_WORD(&reg->hccr);
  75
  76                         /* Get mailbox data. */
  77                         mb[0] = RD_MAILBOX_REG(ha, reg, 0);
  78                         if (mb[0] > 0x3fff && mb[0] < 0x8000) {
  79                                 qla2x00_mbx_completion(ha, mb[0]);
  80                                 status |= MBX_INTERRUPT;
  81                         } else if (mb[0] > 0x7fff && mb[0] < 0xc000) {
  82                                 mb[1] = RD_MAILBOX_REG(ha, reg, 1);
  83                                 mb[2] = RD_MAILBOX_REG(ha, reg, 2);
  84                                 mb[3] = RD_MAILBOX_REG(ha, reg, 3);
  85                                 qla2x00_async_event(ha, mb);
  86                         } else {
  87                                 /*EMPTY*/
  88                                 DEBUG2(printk("scsi(%ld): Unrecognized "
  89                                     "interrupt type (%d).\n",
  90                                     ha->host_no, mb[0]));
  91                         }
  92                         /* Release mailbox registers. */
  93                         WRT_REG_WORD(&reg->semaphore, 0);
  94                         RD_REG_WORD(&reg->semaphore);
  95                 } else {
  96                         qla2x00_process_response_queue(ha);
  97
  98                         WRT_REG_WORD(&reg->hccr, HCCR_CLR_RISC_INT);
  99                         RD_REG_WORD(&reg->hccr);
 100                 }
 101         }
 102         spin_unlock_irqrestore(&ha->hardware_lock, flags);
 103
 104         if (test_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags) &&
 105             (status & MBX_INTERRUPT) && ha->flags.mbox_int) {
 106                 set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
 107                 up(&ha->mbx_intr_sem);
 108         }
 109
 110         return (IRQ_HANDLED);
 111 }
 112
 113 /**
 114  * qla2300_intr_handler() - Process interrupts for the ISP23xx and ISP63xx.
 115  * @irq:
 116  * @dev_id: SCSI driver HA context
 117  *
 118  * Called by system whenever the host adapter generates an interrupt.
 119  *
 120  * Returns handled flag.
 121  */
 122 irqreturn_t
 123 qla2300_intr_handler(int irq, void *dev_id)
 124 {
 125         scsi_qla_host_t *ha;
 126         struct device_reg_2xxx __iomem *reg;
 127         int             status;
 128         unsigned long   flags;
 129         unsigned long   iter;
 130         uint32_t        stat;
 131         uint16_t        hccr;
 132         uint16_t        mb[4];
 133
 134         ha = (scsi_qla_host_t *) dev_id;
 135         if (!ha) {
 136                 printk(KERN_INFO
 137                     "%s(): NULL host pointer\n", __func__);
 138                 return (IRQ_NONE);
 139         }
 140
 141         reg = &ha->iobase->isp;
 142         status = 0;
 143
 144         spin_lock_irqsave(&ha->hardware_lock, flags);
 145         for (iter = 50; iter--; ) {
 146                 stat = RD_REG_DWORD(&reg->u.isp2300.host_status);
 147                 if (stat & HSR_RISC_PAUSED) {
 148                         if (pci_channel_offline(ha->pdev))
 149                                 break;
 150
 151                         hccr = RD_REG_WORD(&reg->hccr);
 152                         if (hccr & (BIT_15 | BIT_13 | BIT_11 | BIT_8))
 153                                 qla_printk(KERN_INFO, ha, "Parity error -- "
 154                                     "HCCR=%x, Dumping firmware!\n", hccr);
 155                         else
 156                                 qla_printk(KERN_INFO, ha, "RISC paused -- "
 157                                     "HCCR=%x, Dumping firmware!\n", hccr);
 158
 159                         /*
 160                          * Issue a "HARD" reset in order for the RISC
 161                          * interrupt bit to be cleared.  Schedule a big
 162                          * hammmer to get out of the RISC PAUSED state.
 163                          */
 164                         WRT_REG_WORD(&reg->hccr, HCCR_RESET_RISC);
 165                         RD_REG_WORD(&reg->hccr);
 166
 167                         ha->isp_ops->fw_dump(ha, 1);
 168                         set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
 169                         break;
 170                 } else if ((stat & HSR_RISC_INT) == 0)
 171                         break;
 172
 173                 switch (stat & 0xff) {
 174                 case 0x1:
 175                 case 0x2:
 176                 case 0x10:
 177                 case 0x11:
 178                         qla2x00_mbx_completion(ha, MSW(stat));
 179                         status |= MBX_INTERRUPT;
 180
 181                         /* Release mailbox registers. */
 182                         WRT_REG_WORD(&reg->semaphore, 0);
 183                         break;
 184                 case 0x12:
 185                         mb[0] = MSW(stat);
 186                         mb[1] = RD_MAILBOX_REG(ha, reg, 1);
 187                         mb[2] = RD_MAILBOX_REG(ha, reg, 2);
 188                         mb[3] = RD_MAILBOX_REG(ha, reg, 3);
 189                         qla2x00_async_event(ha, mb);
 190                         break;
 191                 case 0x13:
 192                         qla2x00_process_response_queue(ha);
 193                         break;
 194                 case 0x15:
 195                         mb[0] = MBA_CMPLT_1_16BIT;
 196                         mb[1] = MSW(stat);
 197                         qla2x00_async_event(ha, mb);
 198                         break;
 199                 case 0x16:
 200                         mb[0] = MBA_SCSI_COMPLETION;
 201                         mb[1] = MSW(stat);
 202                         mb[2] = RD_MAILBOX_REG(ha, reg, 2);
 203                         qla2x00_async_event(ha, mb);
 204                         break;
 205                 default:
 206                         DEBUG2(printk("scsi(%ld): Unrecognized interrupt type "
 207                             "(%d).\n",
 208                             ha->host_no, stat & 0xff));
 209                         break;
 210                 }
 211                 WRT_REG_WORD(&reg->hccr, HCCR_CLR_RISC_INT);
 212                 RD_REG_WORD_RELAXED(&reg->hccr);
 213         }
 214         spin_unlock_irqrestore(&ha->hardware_lock, flags);
 215
 216         if (test_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags) &&
 217             (status & MBX_INTERRUPT) && ha->flags.mbox_int) {
 218                 set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
 219                 up(&ha->mbx_intr_sem);
 220         }
 221
 222         return (IRQ_HANDLED);
 223 }
 224
 225 /**
 226  * qla2x00_mbx_completion() - Process mailbox command completions.
 227  * @ha: SCSI driver HA context
 228  * @mb0: Mailbox0 register
 229  */
 230 static void
 231 qla2x00_mbx_completion(scsi_qla_host_t *ha, uint16_t mb0)
 232 {
 233         uint16_t        cnt;
 234         uint16_t __iomem *wptr;
 235         struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
 236
 237         /* Load return mailbox registers. */
 238         ha->flags.mbox_int = 1;
 239         ha->mailbox_out[0] = mb0;
 240         wptr = (uint16_t __iomem *)MAILBOX_REG(ha, reg, 1);
 241
 242         for (cnt = 1; cnt < ha->mbx_count; cnt++) {
 243                 if (IS_QLA2200(ha) && cnt == 8)
 244                         wptr = (uint16_t __iomem *)MAILBOX_REG(ha, reg, 8);
 245                 if (cnt == 4 || cnt == 5)
 246                         ha->mailbox_out[cnt] = qla2x00_debounce_register(wptr);
 247                 else
 248                         ha->mailbox_out[cnt] = RD_REG_WORD(wptr);
 249
 250                 wptr++;
 251         }
 252
 253         if (ha->mcp) {
 254                 DEBUG3(printk("%s(%ld): Got mailbox completion. cmd=%x.\n",
 255                     __func__, ha->host_no, ha->mcp->mb[0]));
 256         } else {
 257                 DEBUG2_3(printk("%s(%ld): MBX pointer ERROR!\n",
 258                     __func__, ha->host_no));
 259         }
 260 }
 261
 262 /**
 263  * qla2x00_async_event() - Process aynchronous events.
 264  * @ha: SCSI driver HA context
 265  * @mb: Mailbox registers (0 - 3)
 266  */
 267 void
 268 qla2x00_async_event(scsi_qla_host_t *ha, uint16_t *mb)
 269 {
 270 #define LS_UNKNOWN      2
 271         static char     *link_speeds[5] = { "1", "2", "?", "4", "8" };
 272         char            *link_speed;
 273         uint16_t        handle_cnt;
 274         uint16_t        cnt;
 275         uint32_t        handles[5];
 276         struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
 277         uint32_t        rscn_entry, host_pid;
 278         uint8_t         rscn_queue_index;
 279
 280         /* Setup to process RIO completion. */
 281         handle_cnt = 0;
 282         switch (mb[0]) {
 283         case MBA_SCSI_COMPLETION:
 284                 handles[0] = le32_to_cpu((uint32_t)((mb[2] << 16) | mb[1]));
 285                 handle_cnt = 1;
 286                 break;
 287         case MBA_CMPLT_1_16BIT:
 288                 handles[0] = mb[1];
 289                 handle_cnt = 1;
 290                 mb[0] = MBA_SCSI_COMPLETION;
 291                 break;
 292         case MBA_CMPLT_2_16BIT:
 293                 handles[0] = mb[1];
 294                 handles[1] = mb[2];
 295                 handle_cnt = 2;
 296                 mb[0] = MBA_SCSI_COMPLETION;
 297                 break;
 298         case MBA_CMPLT_3_16BIT:
 299                 handles[0] = mb[1];
 300                 handles[1] = mb[2];
 301                 handles[2] = mb[3];
 302                 handle_cnt = 3;
 303                 mb[0] = MBA_SCSI_COMPLETION;
 304                 break;
 305         case MBA_CMPLT_4_16BIT:
 306                 handles[0] = mb[1];
 307                 handles[1] = mb[2];
 308                 handles[2] = mb[3];
 309                 handles[3] = (uint32_t)RD_MAILBOX_REG(ha, reg, 6);
 310                 handle_cnt = 4;
 311                 mb[0] = MBA_SCSI_COMPLETION;
 312                 break;
 313         case MBA_CMPLT_5_16BIT:
 314                 handles[0] = mb[1];
 315                 handles[1] = mb[2];
 316                 handles[2] = mb[3];
 317                 handles[3] = (uint32_t)RD_MAILBOX_REG(ha, reg, 6);
 318                 handles[4] = (uint32_t)RD_MAILBOX_REG(ha, reg, 7);
 319                 handle_cnt = 5;
 320                 mb[0] = MBA_SCSI_COMPLETION;
 321                 break;
 322         case MBA_CMPLT_2_32BIT:
 323                 handles[0] = le32_to_cpu((uint32_t)((mb[2] << 16) | mb[1]));
 324                 handles[1] = le32_to_cpu(
 325                     ((uint32_t)(RD_MAILBOX_REG(ha, reg, 7) << 16)) |
 326                     RD_MAILBOX_REG(ha, reg, 6));
 327                 handle_cnt = 2;
 328                 mb[0] = MBA_SCSI_COMPLETION;
 329                 break;
 330         default:
 331                 break;
 332         }
 333
 334         switch (mb[0]) {
 335         case MBA_SCSI_COMPLETION:       /* Fast Post */
 336                 if (!ha->flags.online)
 337                         break;
 338
 339                 for (cnt = 0; cnt < handle_cnt; cnt++)
 340                         qla2x00_process_completed_request(ha, handles[cnt]);
 341                 break;
 342
 343         case MBA_RESET:                 /* Reset */
 344                 DEBUG2(printk("scsi(%ld): Asynchronous RESET.\n", ha->host_no));
 345
 346                 set_bit(RESET_MARKER_NEEDED, &ha->dpc_flags);
 347                 break;
 348
 349         case MBA_SYSTEM_ERR:            /* System Error */
 350                 qla_printk(KERN_INFO, ha,
 351                     "ISP System Error - mbx1=%xh mbx2=%xh mbx3=%xh.\n",
 352                     mb[1], mb[2], mb[3]);
 353
 354                 ha->isp_ops->fw_dump(ha, 1);
 355
 356                 if (IS_FWI2_CAPABLE(ha)) {
 357                         if (mb[1] == 0 && mb[2] == 0) {
 358                                 qla_printk(KERN_ERR, ha,
 359                                     "Unrecoverable Hardware Error: adapter "
 360                                     "marked OFFLINE!\n");
 361                                 ha->flags.online = 0;
 362                         } else
 363                                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
 364                 } else if (mb[1] == 0) {
 365                         qla_printk(KERN_INFO, ha,
 366                             "Unrecoverable Hardware Error: adapter marked "
 367                             "OFFLINE!\n");
 368                         ha->flags.online = 0;
 369                 } else
 370                         set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
 371                 break;
 372
 373         case MBA_REQ_TRANSFER_ERR:      /* Request Transfer Error */
 374                 DEBUG2(printk("scsi(%ld): ISP Request Transfer Error.\n",
 375                     ha->host_no));
 376                 qla_printk(KERN_WARNING, ha, "ISP Request Transfer Error.\n");
 377
 378                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
 379                 break;
 380
 381         case MBA_RSP_TRANSFER_ERR:      /* Response Transfer Error */
 382                 DEBUG2(printk("scsi(%ld): ISP Response Transfer Error.\n",
 383                     ha->host_no));
 384                 qla_printk(KERN_WARNING, ha, "ISP Response Transfer Error.\n");
 385
 386                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
 387                 break;
 388
 389         case MBA_WAKEUP_THRES:          /* Request Queue Wake-up */
 390                 DEBUG2(printk("scsi(%ld): Asynchronous WAKEUP_THRES.\n",
 391                     ha->host_no));
 392                 break;
 393
 394         case MBA_LIP_OCCURRED:          /* Loop Initialization Procedure */
 395                 DEBUG2(printk("scsi(%ld): LIP occured (%x).\n", ha->host_no,
 396                     mb[1]));
 397                 qla_printk(KERN_INFO, ha, "LIP occured (%x).\n", mb[1]);
 398
 399                 if (atomic_read(&ha->loop_state) != LOOP_DOWN) {
 400                         atomic_set(&ha->loop_state, LOOP_DOWN);
 401                         atomic_set(&ha->loop_down_timer, LOOP_DOWN_TIME);
 402                         qla2x00_mark_all_devices_lost(ha, 1);
 403                 }
 404
 405                 if (ha->parent) {
 406                         atomic_set(&ha->vp_state, VP_FAILED);
 407                         fc_vport_set_state(ha->fc_vport, FC_VPORT_FAILED);
 408                 }
 409
 410                 set_bit(REGISTER_FC4_NEEDED, &ha->dpc_flags);
 411
 412                 ha->flags.management_server_logged_in = 0;
 413                 break;
 414
 415         case MBA_LOOP_UP:               /* Loop Up Event */
 416                 if (IS_QLA2100(ha) || IS_QLA2200(ha)) {
 417                         link_speed = link_speeds[0];
 418                         ha->link_data_rate = PORT_SPEED_1GB;
 419                 } else {
 420                         link_speed = link_speeds[LS_UNKNOWN];
 421                         if (mb[1] < 5)
 422                                 link_speed = link_speeds[mb[1]];
 423                         ha->link_data_rate = mb[1];
 424                 }
 425
 426                 DEBUG2(printk("scsi(%ld): Asynchronous LOOP UP (%s Gbps).\n",
 427                     ha->host_no, link_speed));
 428                 qla_printk(KERN_INFO, ha, "LOOP UP detected (%s Gbps).\n",
 429                     link_speed);
 430
 431                 ha->flags.management_server_logged_in = 0;
 432                 break;
 433
 434         case MBA_LOOP_DOWN:             /* Loop Down Event */
 435                 DEBUG2(printk("scsi(%ld): Asynchronous LOOP DOWN (%x).\n",
 436                     ha->host_no, mb[1]));
 437                 qla_printk(KERN_INFO, ha, "LOOP DOWN detected (%x).\n", mb[1]);
 438
 439                 if (atomic_read(&ha->loop_state) != LOOP_DOWN) {
 440                         atomic_set(&ha->loop_state, LOOP_DOWN);
 441                         atomic_set(&ha->loop_down_timer, LOOP_DOWN_TIME);
 442                         ha->device_flags |= DFLG_NO_CABLE;
 443                         qla2x00_mark_all_devices_lost(ha, 1);
 444                 }
 445
 446                 if (ha->parent) {
 447                         atomic_set(&ha->vp_state, VP_FAILED);
 448                         fc_vport_set_state(ha->fc_vport, FC_VPORT_FAILED);
 449                 }
 450
 451                 ha->flags.management_server_logged_in = 0;
 452                 ha->link_data_rate = PORT_SPEED_UNKNOWN;
 453                 if (ql2xfdmienable)
 454                         set_bit(REGISTER_FDMI_NEEDED, &ha->dpc_flags);
 455                 break;
 456
 457         case MBA_LIP_RESET:             /* LIP reset occurred */
 458                 DEBUG2(printk("scsi(%ld): Asynchronous LIP RESET (%x).\n",
 459                     ha->host_no, mb[1]));
 460                 qla_printk(KERN_INFO, ha,
 461                     "LIP reset occured (%x).\n", mb[1]);
 462
 463                 if (atomic_read(&ha->loop_state) != LOOP_DOWN) {
 464                         atomic_set(&ha->loop_state, LOOP_DOWN);
 465                         atomic_set(&ha->loop_down_timer, LOOP_DOWN_TIME);
 466                         qla2x00_mark_all_devices_lost(ha, 1);
 467                 }
 468
 469                 if (ha->parent) {
 470                         atomic_set(&ha->vp_state, VP_FAILED);
 471                         fc_vport_set_state(ha->fc_vport, FC_VPORT_FAILED);
 472                 }
 473
 474                 set_bit(RESET_MARKER_NEEDED, &ha->dpc_flags);
 475
 476                 ha->operating_mode = LOOP;
 477                 ha->flags.management_server_logged_in = 0;
 478                 break;
 479
 480         case MBA_POINT_TO_POINT:        /* Point-to-Point */
 481                 if (IS_QLA2100(ha))
 482                         break;
 483
 484                 DEBUG2(printk("scsi(%ld): Asynchronous P2P MODE received.\n",
 485                     ha->host_no));
 486
 487                 /*
 488                  * Until there's a transition from loop down to loop up, treat
 489                  * this as loop down only.
 490                  */
 491                 if (atomic_read(&ha->loop_state) != LOOP_DOWN) {
 492                         atomic_set(&ha->loop_state, LOOP_DOWN);
 493                         if (!atomic_read(&ha->loop_down_timer))
 494                                 atomic_set(&ha->loop_down_timer,
 495                                     LOOP_DOWN_TIME);
 496                         qla2x00_mark_all_devices_lost(ha, 1);
 497                 }
 498
 499                 if (ha->parent) {
 500                         atomic_set(&ha->vp_state, VP_FAILED);
 501                         fc_vport_set_state(ha->fc_vport, FC_VPORT_FAILED);
 502                 }
 503
 504                 if (!(test_bit(ABORT_ISP_ACTIVE, &ha->dpc_flags))) {
 505                         set_bit(RESET_MARKER_NEEDED, &ha->dpc_flags);
 506                 }
 507                 set_bit(REGISTER_FC4_NEEDED, &ha->dpc_flags);
 508
 509                 ha->flags.gpsc_supported = 1;
 510                 ha->flags.management_server_logged_in = 0;
 511                 break;
 512
 513         case MBA_CHG_IN_CONNECTION:     /* Change in connection mode */
 514                 if (IS_QLA2100(ha))
 515                         break;
 516
 517                 DEBUG2(printk("scsi(%ld): Asynchronous Change In Connection "
 518                     "received.\n",
 519                     ha->host_no));
 520                 qla_printk(KERN_INFO, ha,
 521                     "Configuration change detected: value=%x.\n", mb[1]);
 522
 523                 if (atomic_read(&ha->loop_state) != LOOP_DOWN) {
 524                         atomic_set(&ha->loop_state, LOOP_DOWN);
 525                         if (!atomic_read(&ha->loop_down_timer))
 526                                 atomic_set(&ha->loop_down_timer,
 527                                     LOOP_DOWN_TIME);
 528                         qla2x00_mark_all_devices_lost(ha, 1);
 529                 }
 530
 531                 if (ha->parent) {
 532                         atomic_set(&ha->vp_state, VP_FAILED);
 533                         fc_vport_set_state(ha->fc_vport, FC_VPORT_FAILED);
 534                 }
 535
 536                 set_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags);
 537                 set_bit(LOCAL_LOOP_UPDATE, &ha->dpc_flags);
 538                 break;
 539
 540         case MBA_PORT_UPDATE:           /* Port database update */
 541                 /*
 542                  * If PORT UPDATE is global (recieved LIP_OCCURED/LIP_RESET
 543                  * event etc. earlier indicating loop is down) then process
 544                  * it.  Otherwise ignore it and Wait for RSCN to come in.
 545                  */
 546                 atomic_set(&ha->loop_down_timer, 0);
 547                 if (atomic_read(&ha->loop_state) != LOOP_DOWN &&
 548                     atomic_read(&ha->loop_state) != LOOP_DEAD) {
 549                         DEBUG2(printk("scsi(%ld): Asynchronous PORT UPDATE "
 550                             "ignored %04x/%04x/%04x.\n", ha->host_no, mb[1],
 551                             mb[2], mb[3]));
 552                         break;
 553                 }
 554
 555                 DEBUG2(printk("scsi(%ld): Asynchronous PORT UPDATE.\n",
 556                     ha->host_no));
 557                 DEBUG(printk(KERN_INFO
 558                     "scsi(%ld): Port database changed %04x %04x %04x.\n",
 559                     ha->host_no, mb[1], mb[2], mb[3]));
 560
 561                 /*
 562                  * Mark all devices as missing so we will login again.
 563                  */
 564                 atomic_set(&ha->loop_state, LOOP_UP);
 565
 566                 qla2x00_mark_all_devices_lost(ha, 1);
 567
 568                 ha->flags.rscn_queue_overflow = 1;
 569
 570                 set_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags);
 571                 set_bit(LOCAL_LOOP_UPDATE, &ha->dpc_flags);
 572                 break;
 573
 574         case MBA_RSCN_UPDATE:           /* State Change Registration */
 575                 /* Check if the Vport has issued a SCR */
 576                 if (ha->parent && test_bit(VP_SCR_NEEDED, &ha->vp_flags))
 577                         break;
 578                 /* Only handle SCNs for our Vport index. */
 579                 if (ha->flags.npiv_supported && ha->vp_idx != mb[3])
 580                         break;
 581
 582                 DEBUG2(printk("scsi(%ld): Asynchronous RSCR UPDATE.\n",
 583                     ha->host_no));
 584                 DEBUG(printk(KERN_INFO
 585                     "scsi(%ld): RSCN database changed -- %04x %04x %04x.\n",
 586                     ha->host_no, mb[1], mb[2], mb[3]));
 587
 588                 rscn_entry = (mb[1] << 16) | mb[2];
 589                 host_pid = (ha->d_id.b.domain << 16) | (ha->d_id.b.area << 8) |
 590                     ha->d_id.b.al_pa;
 591                 if (rscn_entry == host_pid) {
 592                         DEBUG(printk(KERN_INFO
 593                             "scsi(%ld): Ignoring RSCN update to local host "
 594                             "port ID (%06x)\n",
 595                             ha->host_no, host_pid));
 596                         break;
 597                 }
 598
 599                 rscn_queue_index = ha->rscn_in_ptr + 1;
 600                 if (rscn_queue_index == MAX_RSCN_COUNT)
 601                         rscn_queue_index = 0;
 602                 if (rscn_queue_index != ha->rscn_out_ptr) {
 603                         ha->rscn_queue[ha->rscn_in_ptr] = rscn_entry;
 604                         ha->rscn_in_ptr = rscn_queue_index;
 605                 } else {
 606                         ha->flags.rscn_queue_overflow = 1;
 607                 }
 608
 609                 atomic_set(&ha->loop_state, LOOP_UPDATE);
 610                 atomic_set(&ha->loop_down_timer, 0);
 611                 ha->flags.management_server_logged_in = 0;
 612
 613                 set_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags);
 614                 set_bit(RSCN_UPDATE, &ha->dpc_flags);
 615                 break;
 616
 617         /* case MBA_RIO_RESPONSE: */
 618         case MBA_ZIO_RESPONSE:
 619                 DEBUG2(printk("scsi(%ld): [R|Z]IO update completion.\n",
 620                     ha->host_no));
 621                 DEBUG(printk(KERN_INFO
 622                     "scsi(%ld): [R|Z]IO update completion.\n",
 623                     ha->host_no));
 624
 625                 if (IS_FWI2_CAPABLE(ha))
 626                         qla24xx_process_response_queue(ha);
 627                 else
 628                         qla2x00_process_response_queue(ha);
 629                 break;
 630
 631         case MBA_DISCARD_RND_FRAME:
 632                 DEBUG2(printk("scsi(%ld): Discard RND Frame -- %04x %04x "
 633                     "%04x.\n", ha->host_no, mb[1], mb[2], mb[3]));
 634                 break;
 635
 636         case MBA_TRACE_NOTIFICATION:
 637                 DEBUG2(printk("scsi(%ld): Trace Notification -- %04x %04x.\n",
 638                 ha->host_no, mb[1], mb[2]));
 639                 break;
 640         }
 641
 642         if (!ha->parent && ha->num_vhosts)
 643                 qla2x00_alert_all_vps(ha, mb);
 644 }
 645
 646 static void
 647 qla2x00_adjust_sdev_qdepth_up(struct scsi_device *sdev, void *data)
 648 {
 649         fc_port_t *fcport = data;
 650
 651         if (fcport->ha->max_q_depth <= sdev->queue_depth)
 652                 return;
 653
 654         if (sdev->ordered_tags)
 655                 scsi_adjust_queue_depth(sdev, MSG_ORDERED_TAG,
 656                     sdev->queue_depth + 1);
 657         else
 658                 scsi_adjust_queue_depth(sdev, MSG_SIMPLE_TAG,
 659                     sdev->queue_depth + 1);
 660
 661         fcport->last_ramp_up = jiffies;
 662
 663         DEBUG2(qla_printk(KERN_INFO, fcport->ha,
 664             "scsi(%ld:%d:%d:%d): Queue depth adjusted-up to %d.\n",
 665             fcport->ha->host_no, sdev->channel, sdev->id, sdev->lun,
 666             sdev->queue_depth));
 667 }
 668
 669 static void
 670 qla2x00_adjust_sdev_qdepth_down(struct scsi_device *sdev, void *data)
 671 {
 672         fc_port_t *fcport = data;
 673
 674         if (!scsi_track_queue_full(sdev, sdev->queue_depth - 1))
 675                 return;
 676
 677         DEBUG2(qla_printk(KERN_INFO, fcport->ha,
 678             "scsi(%ld:%d:%d:%d): Queue depth adjusted-down to %d.\n",
 679             fcport->ha->host_no, sdev->channel, sdev->id, sdev->lun,
 680             sdev->queue_depth));
 681 }
 682
 683 static inline void
 684 qla2x00_ramp_up_queue_depth(scsi_qla_host_t *ha, srb_t *sp)
 685 {
 686         fc_port_t *fcport;
 687         struct scsi_device *sdev;
 688
 689         sdev = sp->cmd->device;
 690         if (sdev->queue_depth >= ha->max_q_depth)
 691                 return;
 692
 693         fcport = sp->fcport;
 694         if (time_before(jiffies,
 695             fcport->last_ramp_up + ql2xqfullrampup * HZ))
 696                 return;
 697         if (time_before(jiffies,
 698             fcport->last_queue_full + ql2xqfullrampup * HZ))
 699                 return;
 700
 701         starget_for_each_device(sdev->sdev_target, fcport,
 702             qla2x00_adjust_sdev_qdepth_up);
 703 }
 704
 705 /**
 706  * qla2x00_process_completed_request() - Process a Fast Post response.
 707  * @ha: SCSI driver HA context
 708  * @index: SRB index
 709  */
 710 static void
 711 qla2x00_process_completed_request(struct scsi_qla_host *ha, uint32_t index)
 712 {
 713         srb_t *sp;
 714
 715         /* Validate handle. */
 716         if (index >= MAX_OUTSTANDING_COMMANDS) {
 717                 DEBUG2(printk("scsi(%ld): Invalid SCSI completion handle %d.\n",
 718                     ha->host_no, index));
 719                 qla_printk(KERN_WARNING, ha,
 720                     "Invalid SCSI completion handle %d.\n", index);
 721
 722                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
 723                 return;
 724         }
 725
 726         sp = ha->outstanding_cmds[index];
 727         if (sp) {
 728                 /* Free outstanding command slot. */
 729                 ha->outstanding_cmds[index] = NULL;
 730
 731                 CMD_COMPL_STATUS(sp->cmd) = 0L;
 732                 CMD_SCSI_STATUS(sp->cmd) = 0L;
 733
 734                 /* Save ISP completion status */
 735                 sp->cmd->result = DID_OK << 16;
 736
 737                 qla2x00_ramp_up_queue_depth(ha, sp);
 738                 qla2x00_sp_compl(ha, sp);
 739         } else {
 740                 DEBUG2(printk("scsi(%ld): Invalid ISP SCSI completion handle\n",
 741                     ha->host_no));
 742                 qla_printk(KERN_WARNING, ha,
 743                     "Invalid ISP SCSI completion handle\n");
 744
 745                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
 746         }
 747 }
 748
 749 /**
 750  * qla2x00_process_response_queue() - Process response queue entries.
 751  * @ha: SCSI driver HA context
 752  */
 753 void
 754 qla2x00_process_response_queue(struct scsi_qla_host *ha)
 755 {
 756         struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
 757         sts_entry_t     *pkt;
 758         uint16_t        handle_cnt;
 759         uint16_t        cnt;
 760
 761         if (!ha->flags.online)
 762                 return;
 763
 764         while (ha->response_ring_ptr->signature != RESPONSE_PROCESSED) {
 765                 pkt = (sts_entry_t *)ha->response_ring_ptr;
 766
 767                 ha->rsp_ring_index++;
 768                 if (ha->rsp_ring_index == ha->response_q_length) {
 769                         ha->rsp_ring_index = 0;
 770                         ha->response_ring_ptr = ha->response_ring;
 771                 } else {
 772                         ha->response_ring_ptr++;
 773                 }
 774
 775                 if (pkt->entry_status != 0) {
 776                         DEBUG3(printk(KERN_INFO
 777                             "scsi(%ld): Process error entry.\n", ha->host_no));
 778
 779                         qla2x00_error_entry(ha, pkt);
 780                         ((response_t *)pkt)->signature = RESPONSE_PROCESSED;
 781                         wmb();
 782                         continue;
 783                 }
 784
 785                 switch (pkt->entry_type) {
 786                 case STATUS_TYPE:
 787                         qla2x00_status_entry(ha, pkt);
 788                         break;
 789                 case STATUS_TYPE_21:
 790                         handle_cnt = ((sts21_entry_t *)pkt)->handle_count;
 791                         for (cnt = 0; cnt < handle_cnt; cnt++) {
 792                                 qla2x00_process_completed_request(ha,
 793                                     ((sts21_entry_t *)pkt)->handle[cnt]);
 794                         }
 795                         break;
 796                 case STATUS_TYPE_22:
 797                         handle_cnt = ((sts22_entry_t *)pkt)->handle_count;
 798                         for (cnt = 0; cnt < handle_cnt; cnt++) {
 799                                 qla2x00_process_completed_request(ha,
 800                                     ((sts22_entry_t *)pkt)->handle[cnt]);
 801                         }
 802                         break;
 803                 case STATUS_CONT_TYPE:
 804                         qla2x00_status_cont_entry(ha, (sts_cont_entry_t *)pkt);
 805                         break;
 806                 case MS_IOCB_TYPE:
 807                         qla2x00_ms_entry(ha, (ms_iocb_entry_t *)pkt);
 808                         break;
 809                 default:
 810                         /* Type Not Supported. */
 811                         DEBUG4(printk(KERN_WARNING
 812                             "scsi(%ld): Received unknown response pkt type %x "
 813                             "entry status=%x.\n",
 814                             ha->host_no, pkt->entry_type, pkt->entry_status));
 815                         break;
 816                 }
 817                 ((response_t *)pkt)->signature = RESPONSE_PROCESSED;
 818                 wmb();
 819         }
 820
 821         /* Adjust ring index */
 822         WRT_REG_WORD(ISP_RSP_Q_OUT(ha, reg), ha->rsp_ring_index);
 823 }
 824
 825 /**
 826  * qla2x00_status_entry() - Process a Status IOCB entry.
 827  * @ha: SCSI driver HA context
 828  * @pkt: Entry pointer
 829  */
 830 static void
 831 qla2x00_status_entry(scsi_qla_host_t *ha, void *pkt)
 832 {
 833         srb_t           *sp;
 834         fc_port_t       *fcport;
 835         struct scsi_cmnd *cp;
 836         sts_entry_t *sts;
 837         struct sts_entry_24xx *sts24;
 838         uint16_t        comp_status;
 839         uint16_t        scsi_status;
 840         uint8_t         lscsi_status;
 841         int32_t         resid;
 842         uint32_t        sense_len, rsp_info_len, resid_len, fw_resid_len;
 843         uint8_t         *rsp_info, *sense_data;
 844
 845         sts = (sts_entry_t *) pkt;
 846         sts24 = (struct sts_entry_24xx *) pkt;
 847         if (IS_FWI2_CAPABLE(ha)) {
 848                 comp_status = le16_to_cpu(sts24->comp_status);
 849                 scsi_status = le16_to_cpu(sts24->scsi_status) & SS_MASK;
 850         } else {
 851                 comp_status = le16_to_cpu(sts->comp_status);
 852                 scsi_status = le16_to_cpu(sts->scsi_status) & SS_MASK;
 853         }
 854
 855         /* Fast path completion. */
 856         if (comp_status == CS_COMPLETE && scsi_status == 0) {
 857                 qla2x00_process_completed_request(ha, sts->handle);
 858
 859                 return;
 860         }
 861
 862         /* Validate handle. */
 863         if (sts->handle < MAX_OUTSTANDING_COMMANDS) {
 864                 sp = ha->outstanding_cmds[sts->handle];
 865                 ha->outstanding_cmds[sts->handle] = NULL;
 866         } else
 867                 sp = NULL;
 868
 869         if (sp == NULL) {
 870                 DEBUG2(printk("scsi(%ld): Status Entry invalid handle.\n",
 871                     ha->host_no));
 872                 qla_printk(KERN_WARNING, ha, "Status Entry invalid handle.\n");
 873
 874                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
 875                 qla2xxx_wake_dpc(ha);
 876                 return;
 877         }
 878         cp = sp->cmd;
 879         if (cp == NULL) {
 880                 DEBUG2(printk("scsi(%ld): Command already returned back to OS "
 881                     "pkt->handle=%d sp=%p.\n", ha->host_no, sts->handle, sp));
 882                 qla_printk(KERN_WARNING, ha,
 883                     "Command is NULL: already returned to OS (sp=%p)\n", sp);
 884
 885                 return;
 886         }
 887
 888         lscsi_status = scsi_status & STATUS_MASK;
 889         CMD_ENTRY_STATUS(cp) = sts->entry_status;
 890         CMD_COMPL_STATUS(cp) = comp_status;
 891         CMD_SCSI_STATUS(cp) = scsi_status;
 892
 893         fcport = sp->fcport;
 894
 895         sense_len = rsp_info_len = resid_len = fw_resid_len = 0;
 896         if (IS_FWI2_CAPABLE(ha)) {
 897                 sense_len = le32_to_cpu(sts24->sense_len);
 898                 rsp_info_len = le32_to_cpu(sts24->rsp_data_len);
 899                 resid_len = le32_to_cpu(sts24->rsp_residual_count);
 900                 fw_resid_len = le32_to_cpu(sts24->residual_len);
 901                 rsp_info = sts24->data;
 902                 sense_data = sts24->data;
 903                 host_to_fcp_swap(sts24->data, sizeof(sts24->data));
 904         } else {
 905                 sense_len = le16_to_cpu(sts->req_sense_length);
 906                 rsp_info_len = le16_to_cpu(sts->rsp_info_len);
 907                 resid_len = le32_to_cpu(sts->residual_length);
 908                 rsp_info = sts->rsp_info;
 909                 sense_data = sts->req_sense_data;
 910         }
 911
 912         /* Check for any FCP transport errors. */
 913         if (scsi_status & SS_RESPONSE_INFO_LEN_VALID) {
 914                 /* Sense data lies beyond any FCP RESPONSE data. */
 915                 if (IS_FWI2_CAPABLE(ha))
 916                         sense_data += rsp_info_len;
 917                 if (rsp_info_len > 3 && rsp_info[3]) {
 918                         DEBUG2(printk("scsi(%ld:%d:%d:%d) FCP I/O protocol "
 919                             "failure (%x/%02x%02x%02x%02x%02x%02x%02x%02x)..."
 920                             "retrying command\n", ha->host_no,
 921                             cp->device->channel, cp->device->id,
 922                             cp->device->lun, rsp_info_len, rsp_info[0],
 923                             rsp_info[1], rsp_info[2], rsp_info[3], rsp_info[4],
 924                             rsp_info[5], rsp_info[6], rsp_info[7]));
 925
 926                         cp->result = DID_BUS_BUSY << 16;
 927                         qla2x00_sp_compl(ha, sp);
 928                         return;
 929                 }
 930         }
 931
 932         /*
 933          * Based on Host and scsi status generate status code for Linux
 934          */
 935         switch (comp_status) {
 936         case CS_COMPLETE:
 937         case CS_QUEUE_FULL:
 938                 if (scsi_status == 0) {
 939                         cp->result = DID_OK << 16;
 940                         break;
 941                 }
 942                 if (scsi_status & (SS_RESIDUAL_UNDER | SS_RESIDUAL_OVER)) {
 943                         resid = resid_len;
 944                         scsi_set_resid(cp, resid);
 945                         CMD_RESID_LEN(cp) = resid;
 946
 947                         if (!lscsi_status &&
 948                             ((unsigned)(scsi_bufflen(cp) - resid) <
 949                              cp->underflow)) {
 950                                 qla_printk(KERN_INFO, ha,
 951                                            "scsi(%ld:%d:%d:%d): Mid-layer underflow "
 952                                            "detected (%x of %x bytes)...returning "
 953                                            "error status.\n", ha->host_no,
 954                                            cp->device->channel, cp->device->id,
 955                                            cp->device->lun, resid,
 956                                            scsi_bufflen(cp));
 957
 958                                 cp->result = DID_ERROR << 16;
 959                                 break;
 960                         }
 961                 }
 962                 cp->result = DID_OK << 16 | lscsi_status;
 963
 964                 if (lscsi_status == SAM_STAT_TASK_SET_FULL) {
 965                         DEBUG2(printk(KERN_INFO
 966                             "scsi(%ld): QUEUE FULL status detected "
 967                             "0x%x-0x%x.\n", ha->host_no, comp_status,
 968                             scsi_status));
 969
 970                         /* Adjust queue depth for all luns on the port. */
 971                         fcport->last_queue_full = jiffies;
 972                         starget_for_each_device(cp->device->sdev_target,
 973                             fcport, qla2x00_adjust_sdev_qdepth_down);
 974                         break;
 975                 }
 976                 if (lscsi_status != SS_CHECK_CONDITION)
 977                         break;
 978
 979                 /* Copy Sense Data into sense buffer. */
 980                 memset(cp->sense_buffer, 0, sizeof(cp->sense_buffer));
 981
 982                 if (!(scsi_status & SS_SENSE_LEN_VALID))
 983                         break;
 984
 985                 if (sense_len >= sizeof(cp->sense_buffer))
 986                         sense_len = sizeof(cp->sense_buffer);
 987
 988                 CMD_ACTUAL_SNSLEN(cp) = sense_len;
 989                 sp->request_sense_length = sense_len;
 990                 sp->request_sense_ptr = cp->sense_buffer;
 991
 992                 if (sp->request_sense_length > 32)
 993                         sense_len = 32;
 994
 995                 memcpy(cp->sense_buffer, sense_data, sense_len);
 996
 997                 sp->request_sense_ptr += sense_len;
 998                 sp->request_sense_length -= sense_len;
 999                 if (sp->request_sense_length != 0)
1000                         ha->status_srb = sp;
1001
1002                 DEBUG5(printk("%s(): Check condition Sense data, "
1003                     "scsi(%ld:%d:%d:%d) cmd=%p pid=%ld\n", __func__,
1004                     ha->host_no, cp->device->channel, cp->device->id,
1005                     cp->device->lun, cp, cp->serial_number));
1006                 if (sense_len)
1007                         DEBUG5(qla2x00_dump_buffer(cp->sense_buffer,
1008                             CMD_ACTUAL_SNSLEN(cp)));
1009                 break;
1010
1011         case CS_DATA_UNDERRUN:
1012                 resid = resid_len;
1013                 /* Use F/W calculated residual length. */
1014                 if (IS_FWI2_CAPABLE(ha)) {
1015                         if (scsi_status & SS_RESIDUAL_UNDER &&
1016                             resid != fw_resid_len) {
1017                                 scsi_status &= ~SS_RESIDUAL_UNDER;
1018                                 lscsi_status = 0;
1019                         }
1020                         resid = fw_resid_len;
1021                 }
1022
1023                 if (scsi_status & SS_RESIDUAL_UNDER) {
1024                         scsi_set_resid(cp, resid);
1025                         CMD_RESID_LEN(cp) = resid;
1026                 } else {
1027                         DEBUG2(printk(KERN_INFO
1028                             "scsi(%ld:%d:%d) UNDERRUN status detected "
1029                             "0x%x-0x%x. resid=0x%x fw_resid=0x%x cdb=0x%x "
1030                             "os_underflow=0x%x\n", ha->host_no,
1031                             cp->device->id, cp->device->lun, comp_status,
1032                             scsi_status, resid_len, resid, cp->cmnd[0],
1033                             cp->underflow));
1034
1035                 }
1036
1037                 /*
1038                  * Check to see if SCSI Status is non zero. If so report SCSI
1039                  * Status.
1040                  */
1041                 if (lscsi_status != 0) {
1042                         cp->result = DID_OK << 16 | lscsi_status;
1043
1044                         if (lscsi_status == SAM_STAT_TASK_SET_FULL) {
1045                                 DEBUG2(printk(KERN_INFO
1046                                     "scsi(%ld): QUEUE FULL status detected "
1047                                     "0x%x-0x%x.\n", ha->host_no, comp_status,
1048                                     scsi_status));
1049
1050                                 /*
1051                                  * Adjust queue depth for all luns on the
1052                                  * port.
1053                                  */
1054                                 fcport->last_queue_full = jiffies;
1055                                 starget_for_each_device(
1056                                     cp->device->sdev_target, fcport,
1057                                     qla2x00_adjust_sdev_qdepth_down);
1058                                 break;
1059                         }
1060                         if (lscsi_status != SS_CHECK_CONDITION)
1061                                 break;
1062
1063                         /* Copy Sense Data into sense buffer */
1064                         memset(cp->sense_buffer, 0, sizeof(cp->sense_buffer));
1065
1066                         if (!(scsi_status & SS_SENSE_LEN_VALID))
1067                                 break;
1068
1069                         if (sense_len >= sizeof(cp->sense_buffer))
1070                                 sense_len = sizeof(cp->sense_buffer);
1071
1072                         CMD_ACTUAL_SNSLEN(cp) = sense_len;
1073                         sp->request_sense_length = sense_len;
1074                         sp->request_sense_ptr = cp->sense_buffer;
1075
1076                         if (sp->request_sense_length > 32)
1077                                 sense_len = 32;
1078
1079                         memcpy(cp->sense_buffer, sense_data, sense_len);
1080
1081                         sp->request_sense_ptr += sense_len;
1082                         sp->request_sense_length -= sense_len;
1083                         if (sp->request_sense_length != 0)
1084                                 ha->status_srb = sp;
1085
1086                         DEBUG5(printk("%s(): Check condition Sense data, "
1087                             "scsi(%ld:%d:%d:%d) cmd=%p pid=%ld\n",
1088                             __func__, ha->host_no, cp->device->channel,
1089                             cp->device->id, cp->device->lun, cp,
1090                             cp->serial_number));
1091
1092                         /*
1093                          * In case of a Underrun condition, set both the lscsi
1094                          * status and the completion status to appropriate
1095                          * values.
1096                          */
1097                         if (resid &&
1098                             ((unsigned)(scsi_bufflen(cp) - resid) <
1099                              cp->underflow)) {
1100                                 DEBUG2(qla_printk(KERN_INFO, ha,
1101                                     "scsi(%ld:%d:%d:%d): Mid-layer underflow "
1102                                     "detected (%x of %x bytes)...returning "
1103                                     "error status.\n", ha->host_no,
1104                                     cp->device->channel, cp->device->id,
1105                                     cp->device->lun, resid,
1106                                     scsi_bufflen(cp)));
1107
1108                                 cp->result = DID_ERROR << 16 | lscsi_status;
1109                         }
1110
1111                         if (sense_len)
1112                                 DEBUG5(qla2x00_dump_buffer(cp->sense_buffer,
1113                                     CMD_ACTUAL_SNSLEN(cp)));
1114                 } else {
1115                         /*
1116                          * If RISC reports underrun and target does not report
1117                          * it then we must have a lost frame, so tell upper
1118                          * layer to retry it by reporting a bus busy.
1119                          */
1120                         if (!(scsi_status & SS_RESIDUAL_UNDER)) {
1121                                 DEBUG2(printk("scsi(%ld:%d:%d:%d) Dropped "
1122                                               "frame(s) detected (%x of %x bytes)..."
1123                                               "retrying command.\n", ha->host_no,
1124                                               cp->device->channel, cp->device->id,
1125                                               cp->device->lun, resid,
1126                                               scsi_bufflen(cp)));
1127
1128                                 cp->result = DID_BUS_BUSY << 16;
1129                                 break;
1130                         }
1131
1132                         /* Handle mid-layer underflow */
1133                         if ((unsigned)(scsi_bufflen(cp) - resid) <
1134                             cp->underflow) {
1135                                 qla_printk(KERN_INFO, ha,
1136                                            "scsi(%ld:%d:%d:%d): Mid-layer underflow "
1137                                            "detected (%x of %x bytes)...returning "
1138                                            "error status.\n", ha->host_no,
1139                                            cp->device->channel, cp->device->id,
1140                                            cp->device->lun, resid,
1141                                            scsi_bufflen(cp));
1142
1143                                 cp->result = DID_ERROR << 16;
1144                                 break;
1145                         }
1146
1147                         /* Everybody online, looking good... */
1148                         cp->result = DID_OK << 16;
1149                 }
1150                 break;
1151
1152         case CS_DATA_OVERRUN:
1153                 DEBUG2(printk(KERN_INFO
1154                     "scsi(%ld:%d:%d): OVERRUN status detected 0x%x-0x%x\n",
1155                     ha->host_no, cp->device->id, cp->device->lun, comp_status,
1156                     scsi_status));
1157                 DEBUG2(printk(KERN_INFO
1158                     "CDB: 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n",
1159                     cp->cmnd[0], cp->cmnd[1], cp->cmnd[2], cp->cmnd[3],
1160                     cp->cmnd[4], cp->cmnd[5]));
1161                 DEBUG2(printk(KERN_INFO
1162                     "PID=0x%lx req=0x%x xtra=0x%x -- returning DID_ERROR "
1163                     "status!\n",
1164                     cp->serial_number, scsi_bufflen(cp), resid_len));
1165
1166                 cp->result = DID_ERROR << 16;
1167                 break;
1168
1169         case CS_PORT_LOGGED_OUT:
1170         case CS_PORT_CONFIG_CHG:
1171         case CS_PORT_BUSY:
1172         case CS_INCOMPLETE:
1173         case CS_PORT_UNAVAILABLE:
1174                 /*
1175                  * If the port is in Target Down state, return all IOs for this
1176                  * Target with DID_NO_CONNECT ELSE Queue the IOs in the
1177                  * retry_queue.
1178                  */
1179                 DEBUG2(printk("scsi(%ld:%d:%d): status_entry: Port Down "
1180                     "pid=%ld, compl status=0x%x, port state=0x%x\n",
1181                     ha->host_no, cp->device->id, cp->device->lun,
1182                     cp->serial_number, comp_status,
1183                     atomic_read(&fcport->state)));
1184
1185                 cp->result = DID_BUS_BUSY << 16;
1186                 if (atomic_read(&fcport->state) == FCS_ONLINE) {
1187                         qla2x00_mark_device_lost(ha, fcport, 1, 1);
1188                 }
1189                 break;
1190
1191         case CS_RESET:
1192                 DEBUG2(printk(KERN_INFO
1193                     "scsi(%ld): RESET status detected 0x%x-0x%x.\n",
1194                     ha->host_no, comp_status, scsi_status));
1195
1196                 cp->result = DID_RESET << 16;
1197                 break;
1198
1199         case CS_ABORTED:
1200                 /*
1201                  * hv2.19.12 - DID_ABORT does not retry the request if we
1202                  * aborted this request then abort otherwise it must be a
1203                  * reset.
1204                  */
1205                 DEBUG2(printk(KERN_INFO
1206                     "scsi(%ld): ABORT status detected 0x%x-0x%x.\n",
1207                     ha->host_no, comp_status, scsi_status));
1208
1209                 cp->result = DID_RESET << 16;
1210                 break;
1211
1212         case CS_TIMEOUT:
1213                 cp->result = DID_BUS_BUSY << 16;
1214
1215                 if (IS_FWI2_CAPABLE(ha)) {
1216                         DEBUG2(printk(KERN_INFO
1217                             "scsi(%ld:%d:%d:%d): TIMEOUT status detected "
1218                             "0x%x-0x%x\n", ha->host_no, cp->device->channel,
1219                             cp->device->id, cp->device->lun, comp_status,
1220                             scsi_status));
1221                         break;
1222                 }
1223                 DEBUG2(printk(KERN_INFO
1224                     "scsi(%ld:%d:%d:%d): TIMEOUT status detected 0x%x-0x%x "
1225                     "sflags=%x.\n", ha->host_no, cp->device->channel,
1226                     cp->device->id, cp->device->lun, comp_status, scsi_status,
1227                     le16_to_cpu(sts->status_flags)));
1228
1229                 /* Check to see if logout occurred. */
1230                 if ((le16_to_cpu(sts->status_flags) & SF_LOGOUT_SENT))
1231                         qla2x00_mark_device_lost(ha, fcport, 1, 1);
1232                 break;
1233
1234         default:
1235                 DEBUG3(printk("scsi(%ld): Error detected (unknown status) "
1236                     "0x%x-0x%x.\n", ha->host_no, comp_status, scsi_status));
1237                 qla_printk(KERN_INFO, ha,
1238                     "Unknown status detected 0x%x-0x%x.\n",
1239                     comp_status, scsi_status);
1240
1241                 cp->result = DID_ERROR << 16;
1242                 break;
1243         }
1244
1245         /* Place command on done queue. */
1246         if (ha->status_srb == NULL)
1247                 qla2x00_sp_compl(ha, sp);
1248 }
1249
1250 /**
1251  * qla2x00_status_cont_entry() - Process a Status Continuations entry.
1252  * @ha: SCSI driver HA context
1253  * @pkt: Entry pointer
1254  *
1255  * Extended sense data.
1256  */
1257 static void
1258 qla2x00_status_cont_entry(scsi_qla_host_t *ha, sts_cont_entry_t *pkt)
1259 {
1260         uint8_t         sense_sz = 0;
1261         srb_t           *sp = ha->status_srb;
1262         struct scsi_cmnd *cp;
1263
1264         if (sp != NULL && sp->request_sense_length != 0) {
1265                 cp = sp->cmd;
1266                 if (cp == NULL) {
1267                         DEBUG2(printk("%s(): Cmd already returned back to OS "
1268                             "sp=%p.\n", __func__, sp));
1269                         qla_printk(KERN_INFO, ha,
1270                             "cmd is NULL: already returned to OS (sp=%p)\n",
1271                             sp);
1272
1273                         ha->status_srb = NULL;
1274                         return;
1275                 }
1276
1277                 if (sp->request_sense_length > sizeof(pkt->data)) {
1278                         sense_sz = sizeof(pkt->data);
1279                 } else {
1280                         sense_sz = sp->request_sense_length;
1281                 }
1282
1283                 /* Move sense data. */
1284                 if (IS_FWI2_CAPABLE(ha))
1285                         host_to_fcp_swap(pkt->data, sizeof(pkt->data));
1286                 memcpy(sp->request_sense_ptr, pkt->data, sense_sz);
1287                 DEBUG5(qla2x00_dump_buffer(sp->request_sense_ptr, sense_sz));
1288
1289                 sp->request_sense_ptr += sense_sz;
1290                 sp->request_sense_length -= sense_sz;
1291
1292                 /* Place command on done queue. */
1293                 if (sp->request_sense_length == 0) {
1294                         ha->status_srb = NULL;
1295                         qla2x00_sp_compl(ha, sp);
1296                 }
1297         }
1298 }
1299
1300 /**
1301  * qla2x00_error_entry() - Process an error entry.
1302  * @ha: SCSI driver HA context
1303  * @pkt: Entry pointer
1304  */
1305 static void
1306 qla2x00_error_entry(scsi_qla_host_t *ha, sts_entry_t *pkt)
1307 {
1308         srb_t *sp;
1309
1310 #if defined(QL_DEBUG_LEVEL_2)
1311         if (pkt->entry_status & RF_INV_E_ORDER)
1312                 qla_printk(KERN_ERR, ha, "%s: Invalid Entry Order\n", __func__);
1313         else if (pkt->entry_status & RF_INV_E_COUNT)
1314                 qla_printk(KERN_ERR, ha, "%s: Invalid Entry Count\n", __func__);
1315         else if (pkt->entry_status & RF_INV_E_PARAM)
1316                 qla_printk(KERN_ERR, ha,
1317                     "%s: Invalid Entry Parameter\n", __func__);
1318         else if (pkt->entry_status & RF_INV_E_TYPE)
1319                 qla_printk(KERN_ERR, ha, "%s: Invalid Entry Type\n", __func__);
1320         else if (pkt->entry_status & RF_BUSY)
1321                 qla_printk(KERN_ERR, ha, "%s: Busy\n", __func__);
1322         else
1323                 qla_printk(KERN_ERR, ha, "%s: UNKNOWN flag error\n", __func__);
1324 #endif
1325
1326         /* Validate handle. */
1327         if (pkt->handle < MAX_OUTSTANDING_COMMANDS)
1328                 sp = ha->outstanding_cmds[pkt->handle];
1329         else
1330                 sp = NULL;
1331
1332         if (sp) {
1333                 /* Free outstanding command slot. */
1334                 ha->outstanding_cmds[pkt->handle] = NULL;
1335
1336                 /* Bad payload or header */
1337                 if (pkt->entry_status &
1338                     (RF_INV_E_ORDER | RF_INV_E_COUNT |
1339                      RF_INV_E_PARAM | RF_INV_E_TYPE)) {
1340                         sp->cmd->result = DID_ERROR << 16;
1341                 } else if (pkt->entry_status & RF_BUSY) {
1342                         sp->cmd->result = DID_BUS_BUSY << 16;
1343                 } else {
1344                         sp->cmd->result = DID_ERROR << 16;
1345                 }
1346                 qla2x00_sp_compl(ha, sp);
1347
1348         } else if (pkt->entry_type == COMMAND_A64_TYPE || pkt->entry_type ==
1349             COMMAND_TYPE || pkt->entry_type == COMMAND_TYPE_7) {
1350                 DEBUG2(printk("scsi(%ld): Error entry - invalid handle\n",
1351                     ha->host_no));
1352                 qla_printk(KERN_WARNING, ha,
1353                     "Error entry - invalid handle\n");
1354
1355                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1356                 qla2xxx_wake_dpc(ha);
1357         }
1358 }
1359
1360 /**
1361  * qla2x00_ms_entry() - Process a Management Server entry.
1362  * @ha: SCSI driver HA context
1363  * @index: Response queue out pointer
1364  */
1365 static void
1366 qla2x00_ms_entry(scsi_qla_host_t *ha, ms_iocb_entry_t *pkt)
1367 {
1368         srb_t          *sp;
1369
1370         DEBUG3(printk("%s(%ld): pkt=%p pkthandle=%d.\n",
1371             __func__, ha->host_no, pkt, pkt->handle1));
1372
1373         /* Validate handle. */
1374         if (pkt->handle1 < MAX_OUTSTANDING_COMMANDS)
1375                 sp = ha->outstanding_cmds[pkt->handle1];
1376         else
1377                 sp = NULL;
1378
1379         if (sp == NULL) {
1380                 DEBUG2(printk("scsi(%ld): MS entry - invalid handle\n",
1381                     ha->host_no));
1382                 qla_printk(KERN_WARNING, ha, "MS entry - invalid handle\n");
1383
1384                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1385                 return;
1386         }
1387
1388         CMD_COMPL_STATUS(sp->cmd) = le16_to_cpu(pkt->status);
1389         CMD_ENTRY_STATUS(sp->cmd) = pkt->entry_status;
1390
1391         /* Free outstanding command slot. */
1392         ha->outstanding_cmds[pkt->handle1] = NULL;
1393
1394         qla2x00_sp_compl(ha, sp);
1395 }
1396
1397
1398 /**
1399  * qla24xx_mbx_completion() - Process mailbox command completions.
1400  * @ha: SCSI driver HA context
1401  * @mb0: Mailbox0 register
1402  */
1403 static void
1404 qla24xx_mbx_completion(scsi_qla_host_t *ha, uint16_t mb0)
1405 {
1406         uint16_t        cnt;
1407         uint16_t __iomem *wptr;
1408         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1409
1410         /* Load return mailbox registers. */
1411         ha->flags.mbox_int = 1;
1412         ha->mailbox_out[0] = mb0;
1413         wptr = (uint16_t __iomem *)&reg->mailbox1;
1414
1415         for (cnt = 1; cnt < ha->mbx_count; cnt++) {
1416                 ha->mailbox_out[cnt] = RD_REG_WORD(wptr);
1417                 wptr++;
1418         }
1419
1420         if (ha->mcp) {
1421                 DEBUG3(printk("%s(%ld): Got mailbox completion. cmd=%x.\n",
1422                     __func__, ha->host_no, ha->mcp->mb[0]));
1423         } else {
1424                 DEBUG2_3(printk("%s(%ld): MBX pointer ERROR!\n",
1425                     __func__, ha->host_no));
1426         }
1427 }
1428
1429 /**
1430  * qla24xx_process_response_queue() - Process response queue entries.
1431  * @ha: SCSI driver HA context
1432  */
1433 void
1434 qla24xx_process_response_queue(struct scsi_qla_host *ha)
1435 {
1436         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1437         struct sts_entry_24xx *pkt;
1438
1439         if (!ha->flags.online)
1440                 return;
1441
1442         while (ha->response_ring_ptr->signature != RESPONSE_PROCESSED) {
1443                 pkt = (struct sts_entry_24xx *)ha->response_ring_ptr;
1444
1445                 ha->rsp_ring_index++;
1446                 if (ha->rsp_ring_index == ha->response_q_length) {
1447                         ha->rsp_ring_index = 0;
1448                         ha->response_ring_ptr = ha->response_ring;
1449                 } else {
1450                         ha->response_ring_ptr++;
1451                 }
1452
1453                 if (pkt->entry_status != 0) {
1454                         DEBUG3(printk(KERN_INFO
1455                             "scsi(%ld): Process error entry.\n", ha->host_no));
1456
1457                         qla2x00_error_entry(ha, (sts_entry_t *) pkt);
1458                         ((response_t *)pkt)->signature = RESPONSE_PROCESSED;
1459                         wmb();
1460                         continue;
1461                 }
1462
1463                 switch (pkt->entry_type) {
1464                 case STATUS_TYPE:
1465                         qla2x00_status_entry(ha, pkt);
1466                         break;
1467                 case STATUS_CONT_TYPE:
1468                         qla2x00_status_cont_entry(ha, (sts_cont_entry_t *)pkt);
1469                         break;
1470                 case MS_IOCB_TYPE:
1471                         qla24xx_ms_entry(ha, (struct ct_entry_24xx *)pkt);
1472                         break;
1473                 case VP_RPT_ID_IOCB_TYPE:
1474                         qla24xx_report_id_acquisition(ha,
1475                             (struct vp_rpt_id_entry_24xx *)pkt);
1476                         break;
1477                 default:
1478                         /* Type Not Supported. */
1479                         DEBUG4(printk(KERN_WARNING
1480                             "scsi(%ld): Received unknown response pkt type %x "
1481                             "entry status=%x.\n",
1482                             ha->host_no, pkt->entry_type, pkt->entry_status));
1483                         break;
1484                 }
1485                 ((response_t *)pkt)->signature = RESPONSE_PROCESSED;
1486                 wmb();
1487         }
1488
1489         /* Adjust ring index */
1490         WRT_REG_DWORD(&reg->rsp_q_out, ha->rsp_ring_index);
1491 }
1492
1493 static void
1494 qla2xxx_check_risc_status(scsi_qla_host_t *ha)
1495 {
1496         int rval;
1497         uint32_t cnt;
1498         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1499
1500         if (!IS_QLA25XX(ha))
1501                 return;
1502
1503         rval = QLA_SUCCESS;
1504         WRT_REG_DWORD(&reg->iobase_addr, 0x7C00);
1505         RD_REG_DWORD(&reg->iobase_addr);
1506         WRT_REG_DWORD(&reg->iobase_window, 0x0001);
1507         for (cnt = 10000; (RD_REG_DWORD(&reg->iobase_window) & BIT_0) == 0 &&
1508             rval == QLA_SUCCESS; cnt--) {
1509                 if (cnt) {
1510                         WRT_REG_DWORD(&reg->iobase_window, 0x0001);
1511                         udelay(10);
1512                 } else
1513                         rval = QLA_FUNCTION_TIMEOUT;
1514         }
1515         if (rval == QLA_SUCCESS)
1516                 goto next_test;
1517
1518         WRT_REG_DWORD(&reg->iobase_window, 0x0003);
1519         for (cnt = 100; (RD_REG_DWORD(&reg->iobase_window) & BIT_0) == 0 &&
1520             rval == QLA_SUCCESS; cnt--) {
1521                 if (cnt) {
1522                         WRT_REG_DWORD(&reg->iobase_window, 0x0003);
1523                         udelay(10);
1524                 } else
1525                         rval = QLA_FUNCTION_TIMEOUT;
1526         }
1527         if (rval != QLA_SUCCESS)
1528                 goto done;
1529
1530 next_test:
1531         if (RD_REG_DWORD(&reg->iobase_c8) & BIT_3)
1532                 qla_printk(KERN_INFO, ha, "Additional code -- 0x55AA.\n");
1533
1534 done:
1535         WRT_REG_DWORD(&reg->iobase_window, 0x0000);
1536         RD_REG_DWORD(&reg->iobase_window);
1537 }
1538
1539 /**
1540  * qla24xx_intr_handler() - Process interrupts for the ISP23xx and ISP63xx.
1541  * @irq:
1542  * @dev_id: SCSI driver HA context
1543  *
1544  * Called by system whenever the host adapter generates an interrupt.
1545  *
1546  * Returns handled flag.
1547  */
1548 irqreturn_t
1549 qla24xx_intr_handler(int irq, void *dev_id)
1550 {
1551         scsi_qla_host_t *ha;
1552         struct device_reg_24xx __iomem *reg;
1553         int             status;
1554         unsigned long   flags;
1555         unsigned long   iter;
1556         uint32_t        stat;
1557         uint32_t        hccr;
1558         uint16_t        mb[4];
1559
1560         ha = (scsi_qla_host_t *) dev_id;
1561         if (!ha) {
1562                 printk(KERN_INFO
1563                     "%s(): NULL host pointer\n", __func__);
1564                 return IRQ_NONE;
1565         }
1566
1567         reg = &ha->iobase->isp24;
1568         status = 0;
1569
1570         spin_lock_irqsave(&ha->hardware_lock, flags);
1571         for (iter = 50; iter--; ) {
1572                 stat = RD_REG_DWORD(&reg->host_status);
1573                 if (stat & HSRX_RISC_PAUSED) {
1574                         if (pci_channel_offline(ha->pdev))
1575                                 break;
1576
1577                         hccr = RD_REG_DWORD(&reg->hccr);
1578
1579                         qla_printk(KERN_INFO, ha, "RISC paused -- HCCR=%x, "
1580                             "Dumping firmware!\n", hccr);
1581
1582                         qla2xxx_check_risc_status(ha);
1583
1584                         ha->isp_ops->fw_dump(ha, 1);
1585                         set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1586                         break;
1587                 } else if ((stat & HSRX_RISC_INT) == 0)
1588                         break;
1589
1590                 switch (stat & 0xff) {
1591                 case 0x1:
1592                 case 0x2:
1593                 case 0x10:
1594                 case 0x11:
1595                         qla24xx_mbx_completion(ha, MSW(stat));
1596                         status |= MBX_INTERRUPT;
1597
1598                         break;
1599                 case 0x12:
1600                         mb[0] = MSW(stat);
1601                         mb[1] = RD_REG_WORD(&reg->mailbox1);
1602                         mb[2] = RD_REG_WORD(&reg->mailbox2);
1603                         mb[3] = RD_REG_WORD(&reg->mailbox3);
1604                         qla2x00_async_event(ha, mb);
1605                         break;
1606                 case 0x13:
1607                         qla24xx_process_response_queue(ha);
1608                         break;
1609                 default:
1610                         DEBUG2(printk("scsi(%ld): Unrecognized interrupt type "
1611                             "(%d).\n",
1612                             ha->host_no, stat & 0xff));
1613                         break;
1614                 }
1615                 WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_INT);
1616                 RD_REG_DWORD_RELAXED(&reg->hccr);
1617         }
1618         spin_unlock_irqrestore(&ha->hardware_lock, flags);
1619
1620         if (test_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags) &&
1621             (status & MBX_INTERRUPT) && ha->flags.mbox_int) {
1622                 set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
1623                 up(&ha->mbx_intr_sem);
1624         }
1625
1626         return IRQ_HANDLED;
1627 }
1628
1629 /**
1630  * qla24xx_ms_entry() - Process a Management Server entry.
1631  * @ha: SCSI driver HA context
1632  * @index: Response queue out pointer
1633  */
1634 static void
1635 qla24xx_ms_entry(scsi_qla_host_t *ha, struct ct_entry_24xx *pkt)
1636 {
1637         srb_t          *sp;
1638
1639         DEBUG3(printk("%s(%ld): pkt=%p pkthandle=%d.\n",
1640             __func__, ha->host_no, pkt, pkt->handle));
1641
1642         DEBUG9(printk("%s: ct pkt dump:\n", __func__));
1643         DEBUG9(qla2x00_dump_buffer((void *)pkt, sizeof(struct ct_entry_24xx)));
1644
1645         /* Validate handle. */
1646         if (pkt->handle < MAX_OUTSTANDING_COMMANDS)
1647                 sp = ha->outstanding_cmds[pkt->handle];
1648         else
1649                 sp = NULL;
1650
1651         if (sp == NULL) {
1652                 DEBUG2(printk("scsi(%ld): MS entry - invalid handle\n",
1653                     ha->host_no));
1654                 DEBUG10(printk("scsi(%ld): MS entry - invalid handle\n",
1655                     ha->host_no));
1656                 qla_printk(KERN_WARNING, ha, "MS entry - invalid handle %d\n",
1657                     pkt->handle);
1658
1659                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1660                 return;
1661         }
1662
1663         CMD_COMPL_STATUS(sp->cmd) = le16_to_cpu(pkt->comp_status);
1664         CMD_ENTRY_STATUS(sp->cmd) = pkt->entry_status;
1665
1666         /* Free outstanding command slot. */
1667         ha->outstanding_cmds[pkt->handle] = NULL;
1668
1669         qla2x00_sp_compl(ha, sp);
1670 }
1671
1672 static irqreturn_t
1673 qla24xx_msix_rsp_q(int irq, void *dev_id)
1674 {
1675         scsi_qla_host_t *ha;
1676         struct device_reg_24xx __iomem *reg;
1677         unsigned long flags;
1678
1679         ha = dev_id;
1680         reg = &ha->iobase->isp24;
1681
1682         spin_lock_irqsave(&ha->hardware_lock, flags);
1683
1684         qla24xx_process_response_queue(ha);
1685
1686         WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_INT);
1687
1688         spin_unlock_irqrestore(&ha->hardware_lock, flags);
1689
1690         return IRQ_HANDLED;
1691 }
1692
1693 static irqreturn_t
1694 qla24xx_msix_default(int irq, void *dev_id)
1695 {
1696         scsi_qla_host_t *ha;
1697         struct device_reg_24xx __iomem *reg;
1698         int             status;
1699         unsigned long   flags;
1700         uint32_t        stat;
1701         uint32_t        hccr;
1702         uint16_t        mb[4];
1703
1704         ha = dev_id;
1705         reg = &ha->iobase->isp24;
1706         status = 0;
1707
1708         spin_lock_irqsave(&ha->hardware_lock, flags);
1709         do {
1710                 stat = RD_REG_DWORD(&reg->host_status);
1711                 if (stat & HSRX_RISC_PAUSED) {
1712                         if (pci_channel_offline(ha->pdev))
1713                                 break;
1714
1715                         hccr = RD_REG_DWORD(&reg->hccr);
1716
1717                         qla_printk(KERN_INFO, ha, "RISC paused -- HCCR=%x, "
1718                             "Dumping firmware!\n", hccr);
1719
1720                         qla2xxx_check_risc_status(ha);
1721
1722                         ha->isp_ops->fw_dump(ha, 1);
1723                         set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1724                         break;
1725                 } else if ((stat & HSRX_RISC_INT) == 0)
1726                         break;
1727
1728                 switch (stat & 0xff) {
1729                 case 0x1:
1730                 case 0x2:
1731                 case 0x10:
1732                 case 0x11:
1733                         qla24xx_mbx_completion(ha, MSW(stat));
1734                         status |= MBX_INTERRUPT;
1735
1736                         break;
1737                 case 0x12:
1738                         mb[0] = MSW(stat);
1739                         mb[1] = RD_REG_WORD(&reg->mailbox1);
1740                         mb[2] = RD_REG_WORD(&reg->mailbox2);
1741                         mb[3] = RD_REG_WORD(&reg->mailbox3);
1742                         qla2x00_async_event(ha, mb);
1743                         break;
1744                 case 0x13:
1745                         qla24xx_process_response_queue(ha);
1746                         break;
1747                 default:
1748                         DEBUG2(printk("scsi(%ld): Unrecognized interrupt type "
1749                             "(%d).\n",
1750                             ha->host_no, stat & 0xff));
1751                         break;
1752                 }
1753                 WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_INT);
1754         } while (0);
1755         spin_unlock_irqrestore(&ha->hardware_lock, flags);
1756
1757         if (test_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags) &&
1758             (status & MBX_INTERRUPT) && ha->flags.mbox_int) {
1759                 set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
1760                 up(&ha->mbx_intr_sem);
1761         }
1762
1763         return IRQ_HANDLED;
1764 }
1765
1766 /* Interrupt handling helpers. */
1767
1768 struct qla_init_msix_entry {
1769         uint16_t entry;
1770         uint16_t index;
1771         const char *name;
1772         irq_handler_t handler;
1773 };
1774
1775 static struct qla_init_msix_entry imsix_entries[QLA_MSIX_ENTRIES] = {
1776         { QLA_MSIX_DEFAULT, QLA_MIDX_DEFAULT,
1777                 "qla2xxx (default)", qla24xx_msix_default },
1778
1779         { QLA_MSIX_RSP_Q, QLA_MIDX_RSP_Q,
1780                 "qla2xxx (rsp_q)", qla24xx_msix_rsp_q },
1781 };
1782
1783 static void
1784 qla24xx_disable_msix(scsi_qla_host_t *ha)
1785 {
1786         int i;
1787         struct qla_msix_entry *qentry;
1788
1789         for (i = 0; i < QLA_MSIX_ENTRIES; i++) {
1790                 qentry = &ha->msix_entries[imsix_entries[i].index];
1791                 if (qentry->have_irq)
1792                         free_irq(qentry->msix_vector, ha);
1793         }
1794         pci_disable_msix(ha->pdev);
1795 }
1796
1797 static int
1798 qla24xx_enable_msix(scsi_qla_host_t *ha)
1799 {
1800         int i, ret;
1801         struct msix_entry entries[QLA_MSIX_ENTRIES];
1802         struct qla_msix_entry *qentry;
1803
1804         for (i = 0; i < QLA_MSIX_ENTRIES; i++)
1805                 entries[i].entry = imsix_entries[i].entry;
1806
1807         ret = pci_enable_msix(ha->pdev, entries, ARRAY_SIZE(entries));
1808         if (ret) {
1809                 qla_printk(KERN_WARNING, ha,
1810                     "MSI-X: Failed to enable support -- %d/%d\n",
1811                     QLA_MSIX_ENTRIES, ret);
1812                 goto msix_out;
1813         }
1814         ha->flags.msix_enabled = 1;
1815
1816         for (i = 0; i < QLA_MSIX_ENTRIES; i++) {
1817                 qentry = &ha->msix_entries[imsix_entries[i].index];
1818                 qentry->msix_vector = entries[i].vector;
1819                 qentry->msix_entry = entries[i].entry;
1820                 qentry->have_irq = 0;
1821                 ret = request_irq(qentry->msix_vector,
1822                     imsix_entries[i].handler, 0, imsix_entries[i].name, ha);
1823                 if (ret) {
1824                         qla_printk(KERN_WARNING, ha,
1825                             "MSI-X: Unable to register handler -- %x/%d.\n",
1826                             imsix_entries[i].index, ret);
1827                         qla24xx_disable_msix(ha);
1828                         goto msix_out;
1829                 }
1830                 qentry->have_irq = 1;
1831         }
1832
1833 msix_out:
1834         return ret;
1835 }
1836
1837 int
1838 qla2x00_request_irqs(scsi_qla_host_t *ha)
1839 {
1840         int ret;
1841
1842         /* If possible, enable MSI-X. */
1843         if (!IS_QLA2432(ha) && !IS_QLA2532(ha))
1844                 goto skip_msix;
1845
1846         if (IS_QLA2432(ha) && (ha->chip_revision < QLA_MSIX_CHIP_REV_24XX ||
1847             !QLA_MSIX_FW_MODE_1(ha->fw_attributes))) {
1848                 DEBUG2(qla_printk(KERN_WARNING, ha,
1849                     "MSI-X: Unsupported ISP2432 (0x%X, 0x%X).\n",
1850                     ha->chip_revision, ha->fw_attributes));
1851
1852                 goto skip_msix;
1853         }
1854
1855         ret = qla24xx_enable_msix(ha);
1856         if (!ret) {
1857                 DEBUG2(qla_printk(KERN_INFO, ha,
1858                     "MSI-X: Enabled (0x%X, 0x%X).\n", ha->chip_revision,
1859                     ha->fw_attributes));
1860                 return ret;
1861         }
1862         qla_printk(KERN_WARNING, ha,
1863             "MSI-X: Falling back-to INTa mode -- %d.\n", ret);
1864 skip_msix:
1865
1866         if (!IS_QLA24XX(ha) && !IS_QLA2532(ha))
1867                 goto skip_msi;
1868
1869         ret = pci_enable_msi(ha->pdev);
1870         if (!ret) {
1871                 DEBUG2(qla_printk(KERN_INFO, ha, "MSI: Enabled.\n"));
1872                 ha->flags.msi_enabled = 1;
1873         }
1874 skip_msi:
1875
1876         ret = request_irq(ha->pdev->irq, ha->isp_ops->intr_handler,
1877             IRQF_DISABLED|IRQF_SHARED, QLA2XXX_DRIVER_NAME, ha);
1878         if (!ret) {
1879                 ha->flags.inta_enabled = 1;
1880                 ha->host->irq = ha->pdev->irq;
1881         } else {
1882                 qla_printk(KERN_WARNING, ha,
1883                     "Failed to reserve interrupt %d already in use.\n",
1884                     ha->pdev->irq);
1885         }
1886
1887         return ret;
1888 }
1889
1890 void
1891 qla2x00_free_irqs(scsi_qla_host_t *ha)
1892 {
1893
1894         if (ha->flags.msix_enabled)
1895                 qla24xx_disable_msix(ha);
1896         else if (ha->flags.inta_enabled) {
1897                 free_irq(ha->host->irq, ha);
1898                 pci_disable_msi(ha->pdev);
1899         }
1900 }