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