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