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