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