[SCSI] qla2xxx: Don't explicitly read mbx registers while processing a system-error.
[powerpc.git] / 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
579                 DEBUG2(printk("scsi(%ld): Asynchronous RSCR UPDATE.\n",
580                     ha->host_no));
581                 DEBUG(printk(KERN_INFO
582                     "scsi(%ld): RSCN database changed -- %04x %04x.\n",
583                     ha->host_no, mb[1], mb[2]));
584
585                 rscn_entry = (mb[1] << 16) | mb[2];
586                 host_pid = (ha->d_id.b.domain << 16) | (ha->d_id.b.area << 8) |
587                     ha->d_id.b.al_pa;
588                 if (rscn_entry == host_pid) {
589                         DEBUG(printk(KERN_INFO
590                             "scsi(%ld): Ignoring RSCN update to local host "
591                             "port ID (%06x)\n",
592                             ha->host_no, host_pid));
593                         break;
594                 }
595
596                 rscn_queue_index = ha->rscn_in_ptr + 1;
597                 if (rscn_queue_index == MAX_RSCN_COUNT)
598                         rscn_queue_index = 0;
599                 if (rscn_queue_index != ha->rscn_out_ptr) {
600                         ha->rscn_queue[ha->rscn_in_ptr] = rscn_entry;
601                         ha->rscn_in_ptr = rscn_queue_index;
602                 } else {
603                         ha->flags.rscn_queue_overflow = 1;
604                 }
605
606                 atomic_set(&ha->loop_state, LOOP_UPDATE);
607                 atomic_set(&ha->loop_down_timer, 0);
608                 ha->flags.management_server_logged_in = 0;
609
610                 set_bit(LOOP_RESYNC_NEEDED, &ha->dpc_flags);
611                 set_bit(RSCN_UPDATE, &ha->dpc_flags);
612                 break;
613
614         /* case MBA_RIO_RESPONSE: */
615         case MBA_ZIO_RESPONSE:
616                 DEBUG2(printk("scsi(%ld): [R|Z]IO update completion.\n",
617                     ha->host_no));
618                 DEBUG(printk(KERN_INFO
619                     "scsi(%ld): [R|Z]IO update completion.\n",
620                     ha->host_no));
621
622                 if (IS_FWI2_CAPABLE(ha))
623                         qla24xx_process_response_queue(ha);
624                 else
625                         qla2x00_process_response_queue(ha);
626                 break;
627
628         case MBA_DISCARD_RND_FRAME:
629                 DEBUG2(printk("scsi(%ld): Discard RND Frame -- %04x %04x "
630                     "%04x.\n", ha->host_no, mb[1], mb[2], mb[3]));
631                 break;
632
633         case MBA_TRACE_NOTIFICATION:
634                 DEBUG2(printk("scsi(%ld): Trace Notification -- %04x %04x.\n",
635                 ha->host_no, mb[1], mb[2]));
636                 break;
637         }
638
639         if (!ha->parent && ha->num_vhosts)
640                 qla2x00_alert_all_vps(ha, mb);
641 }
642
643 static void
644 qla2x00_adjust_sdev_qdepth_up(struct scsi_device *sdev, void *data)
645 {
646         fc_port_t *fcport = data;
647
648         if (fcport->ha->max_q_depth <= sdev->queue_depth)
649                 return;
650
651         if (sdev->ordered_tags)
652                 scsi_adjust_queue_depth(sdev, MSG_ORDERED_TAG,
653                     sdev->queue_depth + 1);
654         else
655                 scsi_adjust_queue_depth(sdev, MSG_SIMPLE_TAG,
656                     sdev->queue_depth + 1);
657
658         fcport->last_ramp_up = jiffies;
659
660         DEBUG2(qla_printk(KERN_INFO, fcport->ha,
661             "scsi(%ld:%d:%d:%d): Queue depth adjusted-up to %d.\n",
662             fcport->ha->host_no, sdev->channel, sdev->id, sdev->lun,
663             sdev->queue_depth));
664 }
665
666 static void
667 qla2x00_adjust_sdev_qdepth_down(struct scsi_device *sdev, void *data)
668 {
669         fc_port_t *fcport = data;
670
671         if (!scsi_track_queue_full(sdev, sdev->queue_depth - 1))
672                 return;
673
674         DEBUG2(qla_printk(KERN_INFO, fcport->ha,
675             "scsi(%ld:%d:%d:%d): Queue depth adjusted-down to %d.\n",
676             fcport->ha->host_no, sdev->channel, sdev->id, sdev->lun,
677             sdev->queue_depth));
678 }
679
680 static inline void
681 qla2x00_ramp_up_queue_depth(scsi_qla_host_t *ha, srb_t *sp)
682 {
683         fc_port_t *fcport;
684         struct scsi_device *sdev;
685
686         sdev = sp->cmd->device;
687         if (sdev->queue_depth >= ha->max_q_depth)
688                 return;
689
690         fcport = sp->fcport;
691         if (time_before(jiffies,
692             fcport->last_ramp_up + ql2xqfullrampup * HZ))
693                 return;
694         if (time_before(jiffies,
695             fcport->last_queue_full + ql2xqfullrampup * HZ))
696                 return;
697
698         starget_for_each_device(sdev->sdev_target, fcport,
699             qla2x00_adjust_sdev_qdepth_up);
700 }
701
702 /**
703  * qla2x00_process_completed_request() - Process a Fast Post response.
704  * @ha: SCSI driver HA context
705  * @index: SRB index
706  */
707 static void
708 qla2x00_process_completed_request(struct scsi_qla_host *ha, uint32_t index)
709 {
710         srb_t *sp;
711
712         /* Validate handle. */
713         if (index >= MAX_OUTSTANDING_COMMANDS) {
714                 DEBUG2(printk("scsi(%ld): Invalid SCSI completion handle %d.\n",
715                     ha->host_no, index));
716                 qla_printk(KERN_WARNING, ha,
717                     "Invalid SCSI completion handle %d.\n", index);
718
719                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
720                 return;
721         }
722
723         sp = ha->outstanding_cmds[index];
724         if (sp) {
725                 /* Free outstanding command slot. */
726                 ha->outstanding_cmds[index] = NULL;
727
728                 CMD_COMPL_STATUS(sp->cmd) = 0L;
729                 CMD_SCSI_STATUS(sp->cmd) = 0L;
730
731                 /* Save ISP completion status */
732                 sp->cmd->result = DID_OK << 16;
733
734                 qla2x00_ramp_up_queue_depth(ha, sp);
735                 qla2x00_sp_compl(ha, sp);
736         } else {
737                 DEBUG2(printk("scsi(%ld): Invalid ISP SCSI completion handle\n",
738                     ha->host_no));
739                 qla_printk(KERN_WARNING, ha,
740                     "Invalid ISP SCSI completion handle\n");
741
742                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
743         }
744 }
745
746 /**
747  * qla2x00_process_response_queue() - Process response queue entries.
748  * @ha: SCSI driver HA context
749  */
750 void
751 qla2x00_process_response_queue(struct scsi_qla_host *ha)
752 {
753         struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
754         sts_entry_t     *pkt;
755         uint16_t        handle_cnt;
756         uint16_t        cnt;
757
758         if (!ha->flags.online)
759                 return;
760
761         while (ha->response_ring_ptr->signature != RESPONSE_PROCESSED) {
762                 pkt = (sts_entry_t *)ha->response_ring_ptr;
763
764                 ha->rsp_ring_index++;
765                 if (ha->rsp_ring_index == ha->response_q_length) {
766                         ha->rsp_ring_index = 0;
767                         ha->response_ring_ptr = ha->response_ring;
768                 } else {
769                         ha->response_ring_ptr++;
770                 }
771
772                 if (pkt->entry_status != 0) {
773                         DEBUG3(printk(KERN_INFO
774                             "scsi(%ld): Process error entry.\n", ha->host_no));
775
776                         qla2x00_error_entry(ha, pkt);
777                         ((response_t *)pkt)->signature = RESPONSE_PROCESSED;
778                         wmb();
779                         continue;
780                 }
781
782                 switch (pkt->entry_type) {
783                 case STATUS_TYPE:
784                         qla2x00_status_entry(ha, pkt);
785                         break;
786                 case STATUS_TYPE_21:
787                         handle_cnt = ((sts21_entry_t *)pkt)->handle_count;
788                         for (cnt = 0; cnt < handle_cnt; cnt++) {
789                                 qla2x00_process_completed_request(ha,
790                                     ((sts21_entry_t *)pkt)->handle[cnt]);
791                         }
792                         break;
793                 case STATUS_TYPE_22:
794                         handle_cnt = ((sts22_entry_t *)pkt)->handle_count;
795                         for (cnt = 0; cnt < handle_cnt; cnt++) {
796                                 qla2x00_process_completed_request(ha,
797                                     ((sts22_entry_t *)pkt)->handle[cnt]);
798                         }
799                         break;
800                 case STATUS_CONT_TYPE:
801                         qla2x00_status_cont_entry(ha, (sts_cont_entry_t *)pkt);
802                         break;
803                 case MS_IOCB_TYPE:
804                         qla2x00_ms_entry(ha, (ms_iocb_entry_t *)pkt);
805                         break;
806                 default:
807                         /* Type Not Supported. */
808                         DEBUG4(printk(KERN_WARNING
809                             "scsi(%ld): Received unknown response pkt type %x "
810                             "entry status=%x.\n",
811                             ha->host_no, pkt->entry_type, pkt->entry_status));
812                         break;
813                 }
814                 ((response_t *)pkt)->signature = RESPONSE_PROCESSED;
815                 wmb();
816         }
817
818         /* Adjust ring index */
819         WRT_REG_WORD(ISP_RSP_Q_OUT(ha, reg), ha->rsp_ring_index);
820 }
821
822 /**
823  * qla2x00_status_entry() - Process a Status IOCB entry.
824  * @ha: SCSI driver HA context
825  * @pkt: Entry pointer
826  */
827 static void
828 qla2x00_status_entry(scsi_qla_host_t *ha, void *pkt)
829 {
830         srb_t           *sp;
831         fc_port_t       *fcport;
832         struct scsi_cmnd *cp;
833         sts_entry_t *sts;
834         struct sts_entry_24xx *sts24;
835         uint16_t        comp_status;
836         uint16_t        scsi_status;
837         uint8_t         lscsi_status;
838         int32_t         resid;
839         uint32_t        sense_len, rsp_info_len, resid_len, fw_resid_len;
840         uint8_t         *rsp_info, *sense_data;
841
842         sts = (sts_entry_t *) pkt;
843         sts24 = (struct sts_entry_24xx *) pkt;
844         if (IS_FWI2_CAPABLE(ha)) {
845                 comp_status = le16_to_cpu(sts24->comp_status);
846                 scsi_status = le16_to_cpu(sts24->scsi_status) & SS_MASK;
847         } else {
848                 comp_status = le16_to_cpu(sts->comp_status);
849                 scsi_status = le16_to_cpu(sts->scsi_status) & SS_MASK;
850         }
851
852         /* Fast path completion. */
853         if (comp_status == CS_COMPLETE && scsi_status == 0) {
854                 qla2x00_process_completed_request(ha, sts->handle);
855
856                 return;
857         }
858
859         /* Validate handle. */
860         if (sts->handle < MAX_OUTSTANDING_COMMANDS) {
861                 sp = ha->outstanding_cmds[sts->handle];
862                 ha->outstanding_cmds[sts->handle] = NULL;
863         } else
864                 sp = NULL;
865
866         if (sp == NULL) {
867                 DEBUG2(printk("scsi(%ld): Status Entry invalid handle.\n",
868                     ha->host_no));
869                 qla_printk(KERN_WARNING, ha, "Status Entry invalid handle.\n");
870
871                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
872                 qla2xxx_wake_dpc(ha);
873                 return;
874         }
875         cp = sp->cmd;
876         if (cp == NULL) {
877                 DEBUG2(printk("scsi(%ld): Command already returned back to OS "
878                     "pkt->handle=%d sp=%p.\n", ha->host_no, sts->handle, sp));
879                 qla_printk(KERN_WARNING, ha,
880                     "Command is NULL: already returned to OS (sp=%p)\n", sp);
881
882                 return;
883         }
884
885         lscsi_status = scsi_status & STATUS_MASK;
886         CMD_ENTRY_STATUS(cp) = sts->entry_status;
887         CMD_COMPL_STATUS(cp) = comp_status;
888         CMD_SCSI_STATUS(cp) = scsi_status;
889
890         fcport = sp->fcport;
891
892         sense_len = rsp_info_len = resid_len = fw_resid_len = 0;
893         if (IS_FWI2_CAPABLE(ha)) {
894                 sense_len = le32_to_cpu(sts24->sense_len);
895                 rsp_info_len = le32_to_cpu(sts24->rsp_data_len);
896                 resid_len = le32_to_cpu(sts24->rsp_residual_count);
897                 fw_resid_len = le32_to_cpu(sts24->residual_len);
898                 rsp_info = sts24->data;
899                 sense_data = sts24->data;
900                 host_to_fcp_swap(sts24->data, sizeof(sts24->data));
901         } else {
902                 sense_len = le16_to_cpu(sts->req_sense_length);
903                 rsp_info_len = le16_to_cpu(sts->rsp_info_len);
904                 resid_len = le32_to_cpu(sts->residual_length);
905                 rsp_info = sts->rsp_info;
906                 sense_data = sts->req_sense_data;
907         }
908
909         /* Check for any FCP transport errors. */
910         if (scsi_status & SS_RESPONSE_INFO_LEN_VALID) {
911                 /* Sense data lies beyond any FCP RESPONSE data. */
912                 if (IS_FWI2_CAPABLE(ha))
913                         sense_data += rsp_info_len;
914                 if (rsp_info_len > 3 && rsp_info[3]) {
915                         DEBUG2(printk("scsi(%ld:%d:%d:%d) FCP I/O protocol "
916                             "failure (%x/%02x%02x%02x%02x%02x%02x%02x%02x)..."
917                             "retrying command\n", ha->host_no,
918                             cp->device->channel, cp->device->id,
919                             cp->device->lun, rsp_info_len, rsp_info[0],
920                             rsp_info[1], rsp_info[2], rsp_info[3], rsp_info[4],
921                             rsp_info[5], rsp_info[6], rsp_info[7]));
922
923                         cp->result = DID_BUS_BUSY << 16;
924                         qla2x00_sp_compl(ha, sp);
925                         return;
926                 }
927         }
928
929         /*
930          * Based on Host and scsi status generate status code for Linux
931          */
932         switch (comp_status) {
933         case CS_COMPLETE:
934         case CS_QUEUE_FULL:
935                 if (scsi_status == 0) {
936                         cp->result = DID_OK << 16;
937                         break;
938                 }
939                 if (scsi_status & (SS_RESIDUAL_UNDER | SS_RESIDUAL_OVER)) {
940                         resid = resid_len;
941                         scsi_set_resid(cp, resid);
942                         CMD_RESID_LEN(cp) = resid;
943
944                         if (!lscsi_status &&
945                             ((unsigned)(scsi_bufflen(cp) - resid) <
946                              cp->underflow)) {
947                                 qla_printk(KERN_INFO, ha,
948                                            "scsi(%ld:%d:%d:%d): Mid-layer underflow "
949                                            "detected (%x of %x bytes)...returning "
950                                            "error status.\n", ha->host_no,
951                                            cp->device->channel, cp->device->id,
952                                            cp->device->lun, resid,
953                                            scsi_bufflen(cp));
954
955                                 cp->result = DID_ERROR << 16;
956                                 break;
957                         }
958                 }
959                 cp->result = DID_OK << 16 | lscsi_status;
960
961                 if (lscsi_status == SAM_STAT_TASK_SET_FULL) {
962                         DEBUG2(printk(KERN_INFO
963                             "scsi(%ld): QUEUE FULL status detected "
964                             "0x%x-0x%x.\n", ha->host_no, comp_status,
965                             scsi_status));
966
967                         /* Adjust queue depth for all luns on the port. */
968                         fcport->last_queue_full = jiffies;
969                         starget_for_each_device(cp->device->sdev_target,
970                             fcport, qla2x00_adjust_sdev_qdepth_down);
971                         break;
972                 }
973                 if (lscsi_status != SS_CHECK_CONDITION)
974                         break;
975
976                 /* Copy Sense Data into sense buffer. */
977                 memset(cp->sense_buffer, 0, sizeof(cp->sense_buffer));
978
979                 if (!(scsi_status & SS_SENSE_LEN_VALID))
980                         break;
981
982                 if (sense_len >= sizeof(cp->sense_buffer))
983                         sense_len = sizeof(cp->sense_buffer);
984
985                 CMD_ACTUAL_SNSLEN(cp) = sense_len;
986                 sp->request_sense_length = sense_len;
987                 sp->request_sense_ptr = cp->sense_buffer;
988
989                 if (sp->request_sense_length > 32)
990                         sense_len = 32;
991
992                 memcpy(cp->sense_buffer, sense_data, sense_len);
993
994                 sp->request_sense_ptr += sense_len;
995                 sp->request_sense_length -= sense_len;
996                 if (sp->request_sense_length != 0)
997                         ha->status_srb = sp;
998
999                 DEBUG5(printk("%s(): Check condition Sense data, "
1000                     "scsi(%ld:%d:%d:%d) cmd=%p pid=%ld\n", __func__,
1001                     ha->host_no, cp->device->channel, cp->device->id,
1002                     cp->device->lun, cp, cp->serial_number));
1003                 if (sense_len)
1004                         DEBUG5(qla2x00_dump_buffer(cp->sense_buffer,
1005                             CMD_ACTUAL_SNSLEN(cp)));
1006                 break;
1007
1008         case CS_DATA_UNDERRUN:
1009                 resid = resid_len;
1010                 /* Use F/W calculated residual length. */
1011                 if (IS_FWI2_CAPABLE(ha)) {
1012                         if (scsi_status & SS_RESIDUAL_UNDER &&
1013                             resid != fw_resid_len) {
1014                                 scsi_status &= ~SS_RESIDUAL_UNDER;
1015                                 lscsi_status = 0;
1016                         }
1017                         resid = fw_resid_len;
1018                 }
1019
1020                 if (scsi_status & SS_RESIDUAL_UNDER) {
1021                         scsi_set_resid(cp, resid);
1022                         CMD_RESID_LEN(cp) = resid;
1023                 } else {
1024                         DEBUG2(printk(KERN_INFO
1025                             "scsi(%ld:%d:%d) UNDERRUN status detected "
1026                             "0x%x-0x%x. resid=0x%x fw_resid=0x%x cdb=0x%x "
1027                             "os_underflow=0x%x\n", ha->host_no,
1028                             cp->device->id, cp->device->lun, comp_status,
1029                             scsi_status, resid_len, resid, cp->cmnd[0],
1030                             cp->underflow));
1031
1032                 }
1033
1034                 /*
1035                  * Check to see if SCSI Status is non zero. If so report SCSI
1036                  * Status.
1037                  */
1038                 if (lscsi_status != 0) {
1039                         cp->result = DID_OK << 16 | lscsi_status;
1040
1041                         if (lscsi_status == SAM_STAT_TASK_SET_FULL) {
1042                                 DEBUG2(printk(KERN_INFO
1043                                     "scsi(%ld): QUEUE FULL status detected "
1044                                     "0x%x-0x%x.\n", ha->host_no, comp_status,
1045                                     scsi_status));
1046
1047                                 /*
1048                                  * Adjust queue depth for all luns on the
1049                                  * port.
1050                                  */
1051                                 fcport->last_queue_full = jiffies;
1052                                 starget_for_each_device(
1053                                     cp->device->sdev_target, fcport,
1054                                     qla2x00_adjust_sdev_qdepth_down);
1055                                 break;
1056                         }
1057                         if (lscsi_status != SS_CHECK_CONDITION)
1058                                 break;
1059
1060                         /* Copy Sense Data into sense buffer */
1061                         memset(cp->sense_buffer, 0, sizeof(cp->sense_buffer));
1062
1063                         if (!(scsi_status & SS_SENSE_LEN_VALID))
1064                                 break;
1065
1066                         if (sense_len >= sizeof(cp->sense_buffer))
1067                                 sense_len = sizeof(cp->sense_buffer);
1068
1069                         CMD_ACTUAL_SNSLEN(cp) = sense_len;
1070                         sp->request_sense_length = sense_len;
1071                         sp->request_sense_ptr = cp->sense_buffer;
1072
1073                         if (sp->request_sense_length > 32)
1074                                 sense_len = 32;
1075
1076                         memcpy(cp->sense_buffer, sense_data, sense_len);
1077
1078                         sp->request_sense_ptr += sense_len;
1079                         sp->request_sense_length -= sense_len;
1080                         if (sp->request_sense_length != 0)
1081                                 ha->status_srb = sp;
1082
1083                         DEBUG5(printk("%s(): Check condition Sense data, "
1084                             "scsi(%ld:%d:%d:%d) cmd=%p pid=%ld\n",
1085                             __func__, ha->host_no, cp->device->channel,
1086                             cp->device->id, cp->device->lun, cp,
1087                             cp->serial_number));
1088
1089                         /*
1090                          * In case of a Underrun condition, set both the lscsi
1091                          * status and the completion status to appropriate
1092                          * values.
1093                          */
1094                         if (resid &&
1095                             ((unsigned)(scsi_bufflen(cp) - resid) <
1096                              cp->underflow)) {
1097                                 DEBUG2(qla_printk(KERN_INFO, ha,
1098                                     "scsi(%ld:%d:%d:%d): Mid-layer underflow "
1099                                     "detected (%x of %x bytes)...returning "
1100                                     "error status.\n", ha->host_no,
1101                                     cp->device->channel, cp->device->id,
1102                                     cp->device->lun, resid,
1103                                     scsi_bufflen(cp)));
1104
1105                                 cp->result = DID_ERROR << 16 | lscsi_status;
1106                         }
1107
1108                         if (sense_len)
1109                                 DEBUG5(qla2x00_dump_buffer(cp->sense_buffer,
1110                                     CMD_ACTUAL_SNSLEN(cp)));
1111                 } else {
1112                         /*
1113                          * If RISC reports underrun and target does not report
1114                          * it then we must have a lost frame, so tell upper
1115                          * layer to retry it by reporting a bus busy.
1116                          */
1117                         if (!(scsi_status & SS_RESIDUAL_UNDER)) {
1118                                 DEBUG2(printk("scsi(%ld:%d:%d:%d) Dropped "
1119                                               "frame(s) detected (%x of %x bytes)..."
1120                                               "retrying command.\n", ha->host_no,
1121                                               cp->device->channel, cp->device->id,
1122                                               cp->device->lun, resid,
1123                                               scsi_bufflen(cp)));
1124
1125                                 cp->result = DID_BUS_BUSY << 16;
1126                                 break;
1127                         }
1128
1129                         /* Handle mid-layer underflow */
1130                         if ((unsigned)(scsi_bufflen(cp) - resid) <
1131                             cp->underflow) {
1132                                 qla_printk(KERN_INFO, ha,
1133                                            "scsi(%ld:%d:%d:%d): Mid-layer underflow "
1134                                            "detected (%x of %x bytes)...returning "
1135                                            "error status.\n", ha->host_no,
1136                                            cp->device->channel, cp->device->id,
1137                                            cp->device->lun, resid,
1138                                            scsi_bufflen(cp));
1139
1140                                 cp->result = DID_ERROR << 16;
1141                                 break;
1142                         }
1143
1144                         /* Everybody online, looking good... */
1145                         cp->result = DID_OK << 16;
1146                 }
1147                 break;
1148
1149         case CS_DATA_OVERRUN:
1150                 DEBUG2(printk(KERN_INFO
1151                     "scsi(%ld:%d:%d): OVERRUN status detected 0x%x-0x%x\n",
1152                     ha->host_no, cp->device->id, cp->device->lun, comp_status,
1153                     scsi_status));
1154                 DEBUG2(printk(KERN_INFO
1155                     "CDB: 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n",
1156                     cp->cmnd[0], cp->cmnd[1], cp->cmnd[2], cp->cmnd[3],
1157                     cp->cmnd[4], cp->cmnd[5]));
1158                 DEBUG2(printk(KERN_INFO
1159                     "PID=0x%lx req=0x%x xtra=0x%x -- returning DID_ERROR "
1160                     "status!\n",
1161                     cp->serial_number, scsi_bufflen(cp), resid_len));
1162
1163                 cp->result = DID_ERROR << 16;
1164                 break;
1165
1166         case CS_PORT_LOGGED_OUT:
1167         case CS_PORT_CONFIG_CHG:
1168         case CS_PORT_BUSY:
1169         case CS_INCOMPLETE:
1170         case CS_PORT_UNAVAILABLE:
1171                 /*
1172                  * If the port is in Target Down state, return all IOs for this
1173                  * Target with DID_NO_CONNECT ELSE Queue the IOs in the
1174                  * retry_queue.
1175                  */
1176                 DEBUG2(printk("scsi(%ld:%d:%d): status_entry: Port Down "
1177                     "pid=%ld, compl status=0x%x, port state=0x%x\n",
1178                     ha->host_no, cp->device->id, cp->device->lun,
1179                     cp->serial_number, comp_status,
1180                     atomic_read(&fcport->state)));
1181
1182                 cp->result = DID_BUS_BUSY << 16;
1183                 if (atomic_read(&fcport->state) == FCS_ONLINE) {
1184                         qla2x00_mark_device_lost(ha, fcport, 1, 1);
1185                 }
1186                 break;
1187
1188         case CS_RESET:
1189                 DEBUG2(printk(KERN_INFO
1190                     "scsi(%ld): RESET status detected 0x%x-0x%x.\n",
1191                     ha->host_no, comp_status, scsi_status));
1192
1193                 cp->result = DID_RESET << 16;
1194                 break;
1195
1196         case CS_ABORTED:
1197                 /*
1198                  * hv2.19.12 - DID_ABORT does not retry the request if we
1199                  * aborted this request then abort otherwise it must be a
1200                  * reset.
1201                  */
1202                 DEBUG2(printk(KERN_INFO
1203                     "scsi(%ld): ABORT status detected 0x%x-0x%x.\n",
1204                     ha->host_no, comp_status, scsi_status));
1205
1206                 cp->result = DID_RESET << 16;
1207                 break;
1208
1209         case CS_TIMEOUT:
1210                 cp->result = DID_BUS_BUSY << 16;
1211
1212                 if (IS_FWI2_CAPABLE(ha)) {
1213                         DEBUG2(printk(KERN_INFO
1214                             "scsi(%ld:%d:%d:%d): TIMEOUT status detected "
1215                             "0x%x-0x%x\n", ha->host_no, cp->device->channel,
1216                             cp->device->id, cp->device->lun, comp_status,
1217                             scsi_status));
1218                         break;
1219                 }
1220                 DEBUG2(printk(KERN_INFO
1221                     "scsi(%ld:%d:%d:%d): TIMEOUT status detected 0x%x-0x%x "
1222                     "sflags=%x.\n", ha->host_no, cp->device->channel,
1223                     cp->device->id, cp->device->lun, comp_status, scsi_status,
1224                     le16_to_cpu(sts->status_flags)));
1225
1226                 /* Check to see if logout occurred. */
1227                 if ((le16_to_cpu(sts->status_flags) & SF_LOGOUT_SENT))
1228                         qla2x00_mark_device_lost(ha, fcport, 1, 1);
1229                 break;
1230
1231         default:
1232                 DEBUG3(printk("scsi(%ld): Error detected (unknown status) "
1233                     "0x%x-0x%x.\n", ha->host_no, comp_status, scsi_status));
1234                 qla_printk(KERN_INFO, ha,
1235                     "Unknown status detected 0x%x-0x%x.\n",
1236                     comp_status, scsi_status);
1237
1238                 cp->result = DID_ERROR << 16;
1239                 break;
1240         }
1241
1242         /* Place command on done queue. */
1243         if (ha->status_srb == NULL)
1244                 qla2x00_sp_compl(ha, sp);
1245 }
1246
1247 /**
1248  * qla2x00_status_cont_entry() - Process a Status Continuations entry.
1249  * @ha: SCSI driver HA context
1250  * @pkt: Entry pointer
1251  *
1252  * Extended sense data.
1253  */
1254 static void
1255 qla2x00_status_cont_entry(scsi_qla_host_t *ha, sts_cont_entry_t *pkt)
1256 {
1257         uint8_t         sense_sz = 0;
1258         srb_t           *sp = ha->status_srb;
1259         struct scsi_cmnd *cp;
1260
1261         if (sp != NULL && sp->request_sense_length != 0) {
1262                 cp = sp->cmd;
1263                 if (cp == NULL) {
1264                         DEBUG2(printk("%s(): Cmd already returned back to OS "
1265                             "sp=%p.\n", __func__, sp));
1266                         qla_printk(KERN_INFO, ha,
1267                             "cmd is NULL: already returned to OS (sp=%p)\n",
1268                             sp);
1269
1270                         ha->status_srb = NULL;
1271                         return;
1272                 }
1273
1274                 if (sp->request_sense_length > sizeof(pkt->data)) {
1275                         sense_sz = sizeof(pkt->data);
1276                 } else {
1277                         sense_sz = sp->request_sense_length;
1278                 }
1279
1280                 /* Move sense data. */
1281                 if (IS_FWI2_CAPABLE(ha))
1282                         host_to_fcp_swap(pkt->data, sizeof(pkt->data));
1283                 memcpy(sp->request_sense_ptr, pkt->data, sense_sz);
1284                 DEBUG5(qla2x00_dump_buffer(sp->request_sense_ptr, sense_sz));
1285
1286                 sp->request_sense_ptr += sense_sz;
1287                 sp->request_sense_length -= sense_sz;
1288
1289                 /* Place command on done queue. */
1290                 if (sp->request_sense_length == 0) {
1291                         ha->status_srb = NULL;
1292                         qla2x00_sp_compl(ha, sp);
1293                 }
1294         }
1295 }
1296
1297 /**
1298  * qla2x00_error_entry() - Process an error entry.
1299  * @ha: SCSI driver HA context
1300  * @pkt: Entry pointer
1301  */
1302 static void
1303 qla2x00_error_entry(scsi_qla_host_t *ha, sts_entry_t *pkt)
1304 {
1305         srb_t *sp;
1306
1307 #if defined(QL_DEBUG_LEVEL_2)
1308         if (pkt->entry_status & RF_INV_E_ORDER)
1309                 qla_printk(KERN_ERR, ha, "%s: Invalid Entry Order\n", __func__);
1310         else if (pkt->entry_status & RF_INV_E_COUNT)
1311                 qla_printk(KERN_ERR, ha, "%s: Invalid Entry Count\n", __func__);
1312         else if (pkt->entry_status & RF_INV_E_PARAM)
1313                 qla_printk(KERN_ERR, ha,
1314                     "%s: Invalid Entry Parameter\n", __func__);
1315         else if (pkt->entry_status & RF_INV_E_TYPE)
1316                 qla_printk(KERN_ERR, ha, "%s: Invalid Entry Type\n", __func__);
1317         else if (pkt->entry_status & RF_BUSY)
1318                 qla_printk(KERN_ERR, ha, "%s: Busy\n", __func__);
1319         else
1320                 qla_printk(KERN_ERR, ha, "%s: UNKNOWN flag error\n", __func__);
1321 #endif
1322
1323         /* Validate handle. */
1324         if (pkt->handle < MAX_OUTSTANDING_COMMANDS)
1325                 sp = ha->outstanding_cmds[pkt->handle];
1326         else
1327                 sp = NULL;
1328
1329         if (sp) {
1330                 /* Free outstanding command slot. */
1331                 ha->outstanding_cmds[pkt->handle] = NULL;
1332
1333                 /* Bad payload or header */
1334                 if (pkt->entry_status &
1335                     (RF_INV_E_ORDER | RF_INV_E_COUNT |
1336                      RF_INV_E_PARAM | RF_INV_E_TYPE)) {
1337                         sp->cmd->result = DID_ERROR << 16;
1338                 } else if (pkt->entry_status & RF_BUSY) {
1339                         sp->cmd->result = DID_BUS_BUSY << 16;
1340                 } else {
1341                         sp->cmd->result = DID_ERROR << 16;
1342                 }
1343                 qla2x00_sp_compl(ha, sp);
1344
1345         } else if (pkt->entry_type == COMMAND_A64_TYPE || pkt->entry_type ==
1346             COMMAND_TYPE || pkt->entry_type == COMMAND_TYPE_7) {
1347                 DEBUG2(printk("scsi(%ld): Error entry - invalid handle\n",
1348                     ha->host_no));
1349                 qla_printk(KERN_WARNING, ha,
1350                     "Error entry - invalid handle\n");
1351
1352                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1353                 qla2xxx_wake_dpc(ha);
1354         }
1355 }
1356
1357 /**
1358  * qla2x00_ms_entry() - Process a Management Server entry.
1359  * @ha: SCSI driver HA context
1360  * @index: Response queue out pointer
1361  */
1362 static void
1363 qla2x00_ms_entry(scsi_qla_host_t *ha, ms_iocb_entry_t *pkt)
1364 {
1365         srb_t          *sp;
1366
1367         DEBUG3(printk("%s(%ld): pkt=%p pkthandle=%d.\n",
1368             __func__, ha->host_no, pkt, pkt->handle1));
1369
1370         /* Validate handle. */
1371         if (pkt->handle1 < MAX_OUTSTANDING_COMMANDS)
1372                 sp = ha->outstanding_cmds[pkt->handle1];
1373         else
1374                 sp = NULL;
1375
1376         if (sp == NULL) {
1377                 DEBUG2(printk("scsi(%ld): MS entry - invalid handle\n",
1378                     ha->host_no));
1379                 qla_printk(KERN_WARNING, ha, "MS entry - invalid handle\n");
1380
1381                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1382                 return;
1383         }
1384
1385         CMD_COMPL_STATUS(sp->cmd) = le16_to_cpu(pkt->status);
1386         CMD_ENTRY_STATUS(sp->cmd) = pkt->entry_status;
1387
1388         /* Free outstanding command slot. */
1389         ha->outstanding_cmds[pkt->handle1] = NULL;
1390
1391         qla2x00_sp_compl(ha, sp);
1392 }
1393
1394
1395 /**
1396  * qla24xx_mbx_completion() - Process mailbox command completions.
1397  * @ha: SCSI driver HA context
1398  * @mb0: Mailbox0 register
1399  */
1400 static void
1401 qla24xx_mbx_completion(scsi_qla_host_t *ha, uint16_t mb0)
1402 {
1403         uint16_t        cnt;
1404         uint16_t __iomem *wptr;
1405         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1406
1407         /* Load return mailbox registers. */
1408         ha->flags.mbox_int = 1;
1409         ha->mailbox_out[0] = mb0;
1410         wptr = (uint16_t __iomem *)&reg->mailbox1;
1411
1412         for (cnt = 1; cnt < ha->mbx_count; cnt++) {
1413                 ha->mailbox_out[cnt] = RD_REG_WORD(wptr);
1414                 wptr++;
1415         }
1416
1417         if (ha->mcp) {
1418                 DEBUG3(printk("%s(%ld): Got mailbox completion. cmd=%x.\n",
1419                     __func__, ha->host_no, ha->mcp->mb[0]));
1420         } else {
1421                 DEBUG2_3(printk("%s(%ld): MBX pointer ERROR!\n",
1422                     __func__, ha->host_no));
1423         }
1424 }
1425
1426 /**
1427  * qla24xx_process_response_queue() - Process response queue entries.
1428  * @ha: SCSI driver HA context
1429  */
1430 void
1431 qla24xx_process_response_queue(struct scsi_qla_host *ha)
1432 {
1433         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1434         struct sts_entry_24xx *pkt;
1435
1436         if (!ha->flags.online)
1437                 return;
1438
1439         while (ha->response_ring_ptr->signature != RESPONSE_PROCESSED) {
1440                 pkt = (struct sts_entry_24xx *)ha->response_ring_ptr;
1441
1442                 ha->rsp_ring_index++;
1443                 if (ha->rsp_ring_index == ha->response_q_length) {
1444                         ha->rsp_ring_index = 0;
1445                         ha->response_ring_ptr = ha->response_ring;
1446                 } else {
1447                         ha->response_ring_ptr++;
1448                 }
1449
1450                 if (pkt->entry_status != 0) {
1451                         DEBUG3(printk(KERN_INFO
1452                             "scsi(%ld): Process error entry.\n", ha->host_no));
1453
1454                         qla2x00_error_entry(ha, (sts_entry_t *) pkt);
1455                         ((response_t *)pkt)->signature = RESPONSE_PROCESSED;
1456                         wmb();
1457                         continue;
1458                 }
1459
1460                 switch (pkt->entry_type) {
1461                 case STATUS_TYPE:
1462                         qla2x00_status_entry(ha, pkt);
1463                         break;
1464                 case STATUS_CONT_TYPE:
1465                         qla2x00_status_cont_entry(ha, (sts_cont_entry_t *)pkt);
1466                         break;
1467                 case MS_IOCB_TYPE:
1468                         qla24xx_ms_entry(ha, (struct ct_entry_24xx *)pkt);
1469                         break;
1470                 case VP_RPT_ID_IOCB_TYPE:
1471                         qla24xx_report_id_acquisition(ha,
1472                             (struct vp_rpt_id_entry_24xx *)pkt);
1473                         break;
1474                 default:
1475                         /* Type Not Supported. */
1476                         DEBUG4(printk(KERN_WARNING
1477                             "scsi(%ld): Received unknown response pkt type %x "
1478                             "entry status=%x.\n",
1479                             ha->host_no, pkt->entry_type, pkt->entry_status));
1480                         break;
1481                 }
1482                 ((response_t *)pkt)->signature = RESPONSE_PROCESSED;
1483                 wmb();
1484         }
1485
1486         /* Adjust ring index */
1487         WRT_REG_DWORD(&reg->rsp_q_out, ha->rsp_ring_index);
1488 }
1489
1490 static void
1491 qla2xxx_check_risc_status(scsi_qla_host_t *ha)
1492 {
1493         int rval;
1494         uint32_t cnt;
1495         struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;
1496
1497         if (!IS_QLA25XX(ha))
1498                 return;
1499
1500         rval = QLA_SUCCESS;
1501         WRT_REG_DWORD(&reg->iobase_addr, 0x7C00);
1502         RD_REG_DWORD(&reg->iobase_addr);
1503         WRT_REG_DWORD(&reg->iobase_window, 0x0001);
1504         for (cnt = 10000; (RD_REG_DWORD(&reg->iobase_window) & BIT_0) == 0 &&
1505             rval == QLA_SUCCESS; cnt--) {
1506                 if (cnt) {
1507                         WRT_REG_DWORD(&reg->iobase_window, 0x0001);
1508                         udelay(10);
1509                 } else
1510                         rval = QLA_FUNCTION_TIMEOUT;
1511         }
1512         if (rval == QLA_SUCCESS)
1513                 goto next_test;
1514
1515         WRT_REG_DWORD(&reg->iobase_window, 0x0003);
1516         for (cnt = 100; (RD_REG_DWORD(&reg->iobase_window) & BIT_0) == 0 &&
1517             rval == QLA_SUCCESS; cnt--) {
1518                 if (cnt) {
1519                         WRT_REG_DWORD(&reg->iobase_window, 0x0003);
1520                         udelay(10);
1521                 } else
1522                         rval = QLA_FUNCTION_TIMEOUT;
1523         }
1524         if (rval != QLA_SUCCESS)
1525                 goto done;
1526
1527 next_test:
1528         if (RD_REG_DWORD(&reg->iobase_c8) & BIT_3)
1529                 qla_printk(KERN_INFO, ha, "Additional code -- 0x55AA.\n");
1530
1531 done:
1532         WRT_REG_DWORD(&reg->iobase_window, 0x0000);
1533         RD_REG_DWORD(&reg->iobase_window);
1534 }
1535
1536 /**
1537  * qla24xx_intr_handler() - Process interrupts for the ISP23xx and ISP63xx.
1538  * @irq:
1539  * @dev_id: SCSI driver HA context
1540  *
1541  * Called by system whenever the host adapter generates an interrupt.
1542  *
1543  * Returns handled flag.
1544  */
1545 irqreturn_t
1546 qla24xx_intr_handler(int irq, void *dev_id)
1547 {
1548         scsi_qla_host_t *ha;
1549         struct device_reg_24xx __iomem *reg;
1550         int             status;
1551         unsigned long   flags;
1552         unsigned long   iter;
1553         uint32_t        stat;
1554         uint32_t        hccr;
1555         uint16_t        mb[4];
1556
1557         ha = (scsi_qla_host_t *) dev_id;
1558         if (!ha) {
1559                 printk(KERN_INFO
1560                     "%s(): NULL host pointer\n", __func__);
1561                 return IRQ_NONE;
1562         }
1563
1564         reg = &ha->iobase->isp24;
1565         status = 0;
1566
1567         spin_lock_irqsave(&ha->hardware_lock, flags);
1568         for (iter = 50; iter--; ) {
1569                 stat = RD_REG_DWORD(&reg->host_status);
1570                 if (stat & HSRX_RISC_PAUSED) {
1571                         if (pci_channel_offline(ha->pdev))
1572                                 break;
1573
1574                         hccr = RD_REG_DWORD(&reg->hccr);
1575
1576                         qla_printk(KERN_INFO, ha, "RISC paused -- HCCR=%x, "
1577                             "Dumping firmware!\n", hccr);
1578
1579                         qla2xxx_check_risc_status(ha);
1580
1581                         ha->isp_ops->fw_dump(ha, 1);
1582                         set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1583                         break;
1584                 } else if ((stat & HSRX_RISC_INT) == 0)
1585                         break;
1586
1587                 switch (stat & 0xff) {
1588                 case 0x1:
1589                 case 0x2:
1590                 case 0x10:
1591                 case 0x11:
1592                         qla24xx_mbx_completion(ha, MSW(stat));
1593                         status |= MBX_INTERRUPT;
1594
1595                         break;
1596                 case 0x12:
1597                         mb[0] = MSW(stat);
1598                         mb[1] = RD_REG_WORD(&reg->mailbox1);
1599                         mb[2] = RD_REG_WORD(&reg->mailbox2);
1600                         mb[3] = RD_REG_WORD(&reg->mailbox3);
1601                         qla2x00_async_event(ha, mb);
1602                         break;
1603                 case 0x13:
1604                         qla24xx_process_response_queue(ha);
1605                         break;
1606                 default:
1607                         DEBUG2(printk("scsi(%ld): Unrecognized interrupt type "
1608                             "(%d).\n",
1609                             ha->host_no, stat & 0xff));
1610                         break;
1611                 }
1612                 WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_INT);
1613                 RD_REG_DWORD_RELAXED(&reg->hccr);
1614         }
1615         spin_unlock_irqrestore(&ha->hardware_lock, flags);
1616
1617         if (test_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags) &&
1618             (status & MBX_INTERRUPT) && ha->flags.mbox_int) {
1619                 set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
1620                 up(&ha->mbx_intr_sem);
1621         }
1622
1623         return IRQ_HANDLED;
1624 }
1625
1626 /**
1627  * qla24xx_ms_entry() - Process a Management Server entry.
1628  * @ha: SCSI driver HA context
1629  * @index: Response queue out pointer
1630  */
1631 static void
1632 qla24xx_ms_entry(scsi_qla_host_t *ha, struct ct_entry_24xx *pkt)
1633 {
1634         srb_t          *sp;
1635
1636         DEBUG3(printk("%s(%ld): pkt=%p pkthandle=%d.\n",
1637             __func__, ha->host_no, pkt, pkt->handle));
1638
1639         DEBUG9(printk("%s: ct pkt dump:\n", __func__));
1640         DEBUG9(qla2x00_dump_buffer((void *)pkt, sizeof(struct ct_entry_24xx)));
1641
1642         /* Validate handle. */
1643         if (pkt->handle < MAX_OUTSTANDING_COMMANDS)
1644                 sp = ha->outstanding_cmds[pkt->handle];
1645         else
1646                 sp = NULL;
1647
1648         if (sp == NULL) {
1649                 DEBUG2(printk("scsi(%ld): MS entry - invalid handle\n",
1650                     ha->host_no));
1651                 DEBUG10(printk("scsi(%ld): MS entry - invalid handle\n",
1652                     ha->host_no));
1653                 qla_printk(KERN_WARNING, ha, "MS entry - invalid handle %d\n",
1654                     pkt->handle);
1655
1656                 set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1657                 return;
1658         }
1659
1660         CMD_COMPL_STATUS(sp->cmd) = le16_to_cpu(pkt->comp_status);
1661         CMD_ENTRY_STATUS(sp->cmd) = pkt->entry_status;
1662
1663         /* Free outstanding command slot. */
1664         ha->outstanding_cmds[pkt->handle] = NULL;
1665
1666         qla2x00_sp_compl(ha, sp);
1667 }
1668
1669 static irqreturn_t
1670 qla24xx_msix_rsp_q(int irq, void *dev_id)
1671 {
1672         scsi_qla_host_t *ha;
1673         struct device_reg_24xx __iomem *reg;
1674         unsigned long flags;
1675
1676         ha = dev_id;
1677         reg = &ha->iobase->isp24;
1678
1679         spin_lock_irqsave(&ha->hardware_lock, flags);
1680
1681         qla24xx_process_response_queue(ha);
1682
1683         WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_INT);
1684
1685         spin_unlock_irqrestore(&ha->hardware_lock, flags);
1686
1687         return IRQ_HANDLED;
1688 }
1689
1690 static irqreturn_t
1691 qla24xx_msix_default(int irq, void *dev_id)
1692 {
1693         scsi_qla_host_t *ha;
1694         struct device_reg_24xx __iomem *reg;
1695         int             status;
1696         unsigned long   flags;
1697         uint32_t        stat;
1698         uint32_t        hccr;
1699         uint16_t        mb[4];
1700
1701         ha = dev_id;
1702         reg = &ha->iobase->isp24;
1703         status = 0;
1704
1705         spin_lock_irqsave(&ha->hardware_lock, flags);
1706         do {
1707                 stat = RD_REG_DWORD(&reg->host_status);
1708                 if (stat & HSRX_RISC_PAUSED) {
1709                         if (pci_channel_offline(ha->pdev))
1710                                 break;
1711
1712                         hccr = RD_REG_DWORD(&reg->hccr);
1713
1714                         qla_printk(KERN_INFO, ha, "RISC paused -- HCCR=%x, "
1715                             "Dumping firmware!\n", hccr);
1716
1717                         qla2xxx_check_risc_status(ha);
1718
1719                         ha->isp_ops->fw_dump(ha, 1);
1720                         set_bit(ISP_ABORT_NEEDED, &ha->dpc_flags);
1721                         break;
1722                 } else if ((stat & HSRX_RISC_INT) == 0)
1723                         break;
1724
1725                 switch (stat & 0xff) {
1726                 case 0x1:
1727                 case 0x2:
1728                 case 0x10:
1729                 case 0x11:
1730                         qla24xx_mbx_completion(ha, MSW(stat));
1731                         status |= MBX_INTERRUPT;
1732
1733                         break;
1734                 case 0x12:
1735                         mb[0] = MSW(stat);
1736                         mb[1] = RD_REG_WORD(&reg->mailbox1);
1737                         mb[2] = RD_REG_WORD(&reg->mailbox2);
1738                         mb[3] = RD_REG_WORD(&reg->mailbox3);
1739                         qla2x00_async_event(ha, mb);
1740                         break;
1741                 case 0x13:
1742                         qla24xx_process_response_queue(ha);
1743                         break;
1744                 default:
1745                         DEBUG2(printk("scsi(%ld): Unrecognized interrupt type "
1746                             "(%d).\n",
1747                             ha->host_no, stat & 0xff));
1748                         break;
1749                 }
1750                 WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_INT);
1751         } while (0);
1752         spin_unlock_irqrestore(&ha->hardware_lock, flags);
1753
1754         if (test_bit(MBX_INTR_WAIT, &ha->mbx_cmd_flags) &&
1755             (status & MBX_INTERRUPT) && ha->flags.mbox_int) {
1756                 set_bit(MBX_INTERRUPT, &ha->mbx_cmd_flags);
1757                 up(&ha->mbx_intr_sem);
1758         }
1759
1760         return IRQ_HANDLED;
1761 }
1762
1763 /* Interrupt handling helpers. */
1764
1765 struct qla_init_msix_entry {
1766         uint16_t entry;
1767         uint16_t index;
1768         const char *name;
1769         irq_handler_t handler;
1770 };
1771
1772 static struct qla_init_msix_entry imsix_entries[QLA_MSIX_ENTRIES] = {
1773         { QLA_MSIX_DEFAULT, QLA_MIDX_DEFAULT,
1774                 "qla2xxx (default)", qla24xx_msix_default },
1775
1776         { QLA_MSIX_RSP_Q, QLA_MIDX_RSP_Q,
1777                 "qla2xxx (rsp_q)", qla24xx_msix_rsp_q },
1778 };
1779
1780 static void
1781 qla24xx_disable_msix(scsi_qla_host_t *ha)
1782 {
1783         int i;
1784         struct qla_msix_entry *qentry;
1785
1786         for (i = 0; i < QLA_MSIX_ENTRIES; i++) {
1787                 qentry = &ha->msix_entries[imsix_entries[i].index];
1788                 if (qentry->have_irq)
1789                         free_irq(qentry->msix_vector, ha);
1790         }
1791         pci_disable_msix(ha->pdev);
1792 }
1793
1794 static int
1795 qla24xx_enable_msix(scsi_qla_host_t *ha)
1796 {
1797         int i, ret;
1798         struct msix_entry entries[QLA_MSIX_ENTRIES];
1799         struct qla_msix_entry *qentry;
1800
1801         for (i = 0; i < QLA_MSIX_ENTRIES; i++)
1802                 entries[i].entry = imsix_entries[i].entry;
1803
1804         ret = pci_enable_msix(ha->pdev, entries, ARRAY_SIZE(entries));
1805         if (ret) {
1806                 qla_printk(KERN_WARNING, ha,
1807                     "MSI-X: Failed to enable support -- %d/%d\n",
1808                     QLA_MSIX_ENTRIES, ret);
1809                 goto msix_out;
1810         }
1811         ha->flags.msix_enabled = 1;
1812
1813         for (i = 0; i < QLA_MSIX_ENTRIES; i++) {
1814                 qentry = &ha->msix_entries[imsix_entries[i].index];
1815                 qentry->msix_vector = entries[i].vector;
1816                 qentry->msix_entry = entries[i].entry;
1817                 qentry->have_irq = 0;
1818                 ret = request_irq(qentry->msix_vector,
1819                     imsix_entries[i].handler, 0, imsix_entries[i].name, ha);
1820                 if (ret) {
1821                         qla_printk(KERN_WARNING, ha,
1822                             "MSI-X: Unable to register handler -- %x/%d.\n",
1823                             imsix_entries[i].index, ret);
1824                         qla24xx_disable_msix(ha);
1825                         goto msix_out;
1826                 }
1827                 qentry->have_irq = 1;
1828         }
1829
1830 msix_out:
1831         return ret;
1832 }
1833
1834 int
1835 qla2x00_request_irqs(scsi_qla_host_t *ha)
1836 {
1837         int ret;
1838
1839         /* If possible, enable MSI-X. */
1840         if (!IS_QLA2432(ha) && !IS_QLA2532(ha))
1841                 goto skip_msix;
1842
1843         if (IS_QLA2432(ha) && (ha->chip_revision < QLA_MSIX_CHIP_REV_24XX ||
1844             !QLA_MSIX_FW_MODE_1(ha->fw_attributes))) {
1845                 DEBUG2(qla_printk(KERN_WARNING, ha,
1846                     "MSI-X: Unsupported ISP2432 (0x%X, 0x%X).\n",
1847                     ha->chip_revision, ha->fw_attributes));
1848
1849                 goto skip_msix;
1850         }
1851
1852         ret = qla24xx_enable_msix(ha);
1853         if (!ret) {
1854                 DEBUG2(qla_printk(KERN_INFO, ha,
1855                     "MSI-X: Enabled (0x%X, 0x%X).\n", ha->chip_revision,
1856                     ha->fw_attributes));
1857                 return ret;
1858         }
1859         qla_printk(KERN_WARNING, ha,
1860             "MSI-X: Falling back-to INTa mode -- %d.\n", ret);
1861 skip_msix:
1862
1863         if (!IS_QLA24XX(ha) && !IS_QLA2532(ha))
1864                 goto skip_msi;
1865
1866         ret = pci_enable_msi(ha->pdev);
1867         if (!ret) {
1868                 DEBUG2(qla_printk(KERN_INFO, ha, "MSI: Enabled.\n"));
1869                 ha->flags.msi_enabled = 1;
1870         }
1871 skip_msi:
1872
1873         ret = request_irq(ha->pdev->irq, ha->isp_ops->intr_handler,
1874             IRQF_DISABLED|IRQF_SHARED, QLA2XXX_DRIVER_NAME, ha);
1875         if (!ret) {
1876                 ha->flags.inta_enabled = 1;
1877                 ha->host->irq = ha->pdev->irq;
1878         } else {
1879                 qla_printk(KERN_WARNING, ha,
1880                     "Failed to reserve interrupt %d already in use.\n",
1881                     ha->pdev->irq);
1882         }
1883
1884         return ret;
1885 }
1886
1887 void
1888 qla2x00_free_irqs(scsi_qla_host_t *ha)
1889 {
1890
1891         if (ha->flags.msix_enabled)
1892                 qla24xx_disable_msix(ha);
1893         else if (ha->flags.inta_enabled) {
1894                 free_irq(ha->host->irq, ha);
1895                 pci_disable_msi(ha->pdev);
1896         }
1897 }