qla_isr.c 98.0 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
A
Andrew Vasquez 已提交
2
 * QLogic Fibre Channel HBA Driver
3
 * Copyright (c)  2003-2014 QLogic Corporation
L
Linus Torvalds 已提交
4
 *
A
Andrew Vasquez 已提交
5
 * See LICENSE.qla2xxx for copyright and licensing details.
L
Linus Torvalds 已提交
6 7
 */
#include "qla_def.h"
8
#include "qla_target.h"
L
Linus Torvalds 已提交
9

10
#include <linux/delay.h>
11
#include <linux/slab.h>
12
#include <linux/cpu.h>
13
#include <linux/t10-pi.h>
14
#include <scsi/scsi_tcq.h>
15
#include <scsi/scsi_bsg_fc.h>
16
#include <scsi/scsi_eh.h>
17 18
#include <scsi/fc/fc_fs.h>
#include <linux/nvme-fc-driver.h>
19

L
Linus Torvalds 已提交
20
static void qla2x00_mbx_completion(scsi_qla_host_t *, uint16_t);
21
static void qla2x00_status_entry(scsi_qla_host_t *, struct rsp_que *, void *);
22
static void qla2x00_status_cont_entry(struct rsp_que *, sts_cont_entry_t *);
23
static int qla2x00_error_entry(scsi_qla_host_t *, struct rsp_que *,
24
	sts_entry_t *);
25

L
Linus Torvalds 已提交
26 27 28 29 30 31 32 33 34 35
/**
 * qla2100_intr_handler() - Process interrupts for the ISP2100 and ISP2200.
 * @irq:
 * @dev_id: SCSI driver HA context
 *
 * Called by system whenever the host adapter generates an interrupt.
 *
 * Returns handled flag.
 */
irqreturn_t
36
qla2100_intr_handler(int irq, void *dev_id)
L
Linus Torvalds 已提交
37
{
38 39
	scsi_qla_host_t	*vha;
	struct qla_hw_data *ha;
40
	struct device_reg_2xxx __iomem *reg;
L
Linus Torvalds 已提交
41 42
	int		status;
	unsigned long	iter;
43
	uint16_t	hccr;
44
	uint16_t	mb[4];
45
	struct rsp_que *rsp;
46
	unsigned long	flags;
L
Linus Torvalds 已提交
47

48 49
	rsp = (struct rsp_que *) dev_id;
	if (!rsp) {
50 51
		ql_log(ql_log_info, NULL, 0x505d,
		    "%s: NULL response queue pointer.\n", __func__);
L
Linus Torvalds 已提交
52 53 54
		return (IRQ_NONE);
	}

55
	ha = rsp->hw;
56
	reg = &ha->iobase->isp;
L
Linus Torvalds 已提交
57 58
	status = 0;

59
	spin_lock_irqsave(&ha->hardware_lock, flags);
60
	vha = pci_get_drvdata(ha->pdev);
L
Linus Torvalds 已提交
61
	for (iter = 50; iter--; ) {
62
		hccr = RD_REG_WORD(&reg->hccr);
63
		if (qla2x00_check_reg16_for_disconnect(vha, hccr))
64
			break;
65 66 67 68 69 70
		if (hccr & HCCR_RISC_PAUSE) {
			if (pci_channel_offline(ha->pdev))
				break;

			/*
			 * Issue a "HARD" reset in order for the RISC interrupt
71
			 * bit to be cleared.  Schedule a big hammer to get
72 73 74 75 76
			 * out of the RISC PAUSED state.
			 */
			WRT_REG_WORD(&reg->hccr, HCCR_RESET_RISC);
			RD_REG_WORD(&reg->hccr);

77 78
			ha->isp_ops->fw_dump(vha, 1);
			set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
79 80
			break;
		} else if ((RD_REG_WORD(&reg->istatus) & ISR_RISC_INT) == 0)
L
Linus Torvalds 已提交
81 82 83 84 85 86 87
			break;

		if (RD_REG_WORD(&reg->semaphore) & BIT_0) {
			WRT_REG_WORD(&reg->hccr, HCCR_CLR_RISC_INT);
			RD_REG_WORD(&reg->hccr);

			/* Get mailbox data. */
88 89
			mb[0] = RD_MAILBOX_REG(ha, reg, 0);
			if (mb[0] > 0x3fff && mb[0] < 0x8000) {
90
				qla2x00_mbx_completion(vha, mb[0]);
L
Linus Torvalds 已提交
91
				status |= MBX_INTERRUPT;
92 93 94 95
			} else if (mb[0] > 0x7fff && mb[0] < 0xc000) {
				mb[1] = RD_MAILBOX_REG(ha, reg, 1);
				mb[2] = RD_MAILBOX_REG(ha, reg, 2);
				mb[3] = RD_MAILBOX_REG(ha, reg, 3);
96
				qla2x00_async_event(vha, rsp, mb);
L
Linus Torvalds 已提交
97 98
			} else {
				/*EMPTY*/
99 100 101
				ql_dbg(ql_dbg_async, vha, 0x5025,
				    "Unrecognized interrupt type (%d).\n",
				    mb[0]);
L
Linus Torvalds 已提交
102 103 104 105 106
			}
			/* Release mailbox registers. */
			WRT_REG_WORD(&reg->semaphore, 0);
			RD_REG_WORD(&reg->semaphore);
		} else {
107
			qla2x00_process_response_queue(rsp);
L
Linus Torvalds 已提交
108 109 110 111 112

			WRT_REG_WORD(&reg->hccr, HCCR_CLR_RISC_INT);
			RD_REG_WORD(&reg->hccr);
		}
	}
113
	qla2x00_handle_mbx_completion(ha, status);
114
	spin_unlock_irqrestore(&ha->hardware_lock, flags);
L
Linus Torvalds 已提交
115 116 117 118

	return (IRQ_HANDLED);
}

119
bool
120
qla2x00_check_reg32_for_disconnect(scsi_qla_host_t *vha, uint32_t reg)
121 122
{
	/* Check for PCI disconnection */
123
	if (reg == 0xffffffff && !pci_channel_offline(vha->hw->pdev)) {
124
		if (!test_and_set_bit(PFLG_DISCONNECTED, &vha->pci_flags) &&
125 126
		    !test_bit(PFLG_DRIVER_REMOVING, &vha->pci_flags) &&
		    !test_bit(PFLG_DRIVER_PROBING, &vha->pci_flags)) {
127 128 129 130 131 132 133
			/*
			 * Schedule this (only once) on the default system
			 * workqueue so that all the adapter workqueues and the
			 * DPC thread can be shutdown cleanly.
			 */
			schedule_work(&vha->hw->board_disable);
		}
134 135 136 137 138
		return true;
	} else
		return false;
}

139 140 141 142 143 144
bool
qla2x00_check_reg16_for_disconnect(scsi_qla_host_t *vha, uint16_t reg)
{
	return qla2x00_check_reg32_for_disconnect(vha, 0xffff0000 | reg);
}

L
Linus Torvalds 已提交
145 146 147 148 149 150 151 152 153 154
/**
 * qla2300_intr_handler() - Process interrupts for the ISP23xx and ISP63xx.
 * @irq:
 * @dev_id: SCSI driver HA context
 *
 * Called by system whenever the host adapter generates an interrupt.
 *
 * Returns handled flag.
 */
irqreturn_t
155
qla2300_intr_handler(int irq, void *dev_id)
L
Linus Torvalds 已提交
156
{
157
	scsi_qla_host_t	*vha;
158
	struct device_reg_2xxx __iomem *reg;
L
Linus Torvalds 已提交
159 160 161 162
	int		status;
	unsigned long	iter;
	uint32_t	stat;
	uint16_t	hccr;
163
	uint16_t	mb[4];
164 165
	struct rsp_que *rsp;
	struct qla_hw_data *ha;
166
	unsigned long	flags;
L
Linus Torvalds 已提交
167

168 169
	rsp = (struct rsp_que *) dev_id;
	if (!rsp) {
170 171
		ql_log(ql_log_info, NULL, 0x5058,
		    "%s: NULL response queue pointer.\n", __func__);
L
Linus Torvalds 已提交
172 173 174
		return (IRQ_NONE);
	}

175
	ha = rsp->hw;
176
	reg = &ha->iobase->isp;
L
Linus Torvalds 已提交
177 178
	status = 0;

179
	spin_lock_irqsave(&ha->hardware_lock, flags);
180
	vha = pci_get_drvdata(ha->pdev);
L
Linus Torvalds 已提交
181 182
	for (iter = 50; iter--; ) {
		stat = RD_REG_DWORD(&reg->u.isp2300.host_status);
183
		if (qla2x00_check_reg32_for_disconnect(vha, stat))
184
			break;
L
Linus Torvalds 已提交
185
		if (stat & HSR_RISC_PAUSED) {
186
			if (unlikely(pci_channel_offline(ha->pdev)))
187 188
				break;

L
Linus Torvalds 已提交
189
			hccr = RD_REG_WORD(&reg->hccr);
190

L
Linus Torvalds 已提交
191
			if (hccr & (BIT_15 | BIT_13 | BIT_11 | BIT_8))
192 193 194
				ql_log(ql_log_warn, vha, 0x5026,
				    "Parity error -- HCCR=%x, Dumping "
				    "firmware.\n", hccr);
L
Linus Torvalds 已提交
195
			else
196 197 198
				ql_log(ql_log_warn, vha, 0x5027,
				    "RISC paused -- HCCR=%x, Dumping "
				    "firmware.\n", hccr);
L
Linus Torvalds 已提交
199 200 201 202

			/*
			 * Issue a "HARD" reset in order for the RISC
			 * interrupt bit to be cleared.  Schedule a big
203
			 * hammer to get out of the RISC PAUSED state.
L
Linus Torvalds 已提交
204 205 206
			 */
			WRT_REG_WORD(&reg->hccr, HCCR_RESET_RISC);
			RD_REG_WORD(&reg->hccr);
207

208 209
			ha->isp_ops->fw_dump(vha, 1);
			set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
L
Linus Torvalds 已提交
210 211 212 213 214 215 216 217 218
			break;
		} else if ((stat & HSR_RISC_INT) == 0)
			break;

		switch (stat & 0xff) {
		case 0x1:
		case 0x2:
		case 0x10:
		case 0x11:
219
			qla2x00_mbx_completion(vha, MSW(stat));
L
Linus Torvalds 已提交
220 221 222 223 224 225
			status |= MBX_INTERRUPT;

			/* Release mailbox registers. */
			WRT_REG_WORD(&reg->semaphore, 0);
			break;
		case 0x12:
226 227 228 229
			mb[0] = MSW(stat);
			mb[1] = RD_MAILBOX_REG(ha, reg, 1);
			mb[2] = RD_MAILBOX_REG(ha, reg, 2);
			mb[3] = RD_MAILBOX_REG(ha, reg, 3);
230
			qla2x00_async_event(vha, rsp, mb);
231 232
			break;
		case 0x13:
233
			qla2x00_process_response_queue(rsp);
L
Linus Torvalds 已提交
234 235
			break;
		case 0x15:
236 237
			mb[0] = MBA_CMPLT_1_16BIT;
			mb[1] = MSW(stat);
238
			qla2x00_async_event(vha, rsp, mb);
L
Linus Torvalds 已提交
239 240
			break;
		case 0x16:
241 242 243
			mb[0] = MBA_SCSI_COMPLETION;
			mb[1] = MSW(stat);
			mb[2] = RD_MAILBOX_REG(ha, reg, 2);
244
			qla2x00_async_event(vha, rsp, mb);
L
Linus Torvalds 已提交
245 246
			break;
		default:
247 248
			ql_dbg(ql_dbg_async, vha, 0x5028,
			    "Unrecognized interrupt type (%d).\n", stat & 0xff);
L
Linus Torvalds 已提交
249 250 251 252 253
			break;
		}
		WRT_REG_WORD(&reg->hccr, HCCR_CLR_RISC_INT);
		RD_REG_WORD_RELAXED(&reg->hccr);
	}
254
	qla2x00_handle_mbx_completion(ha, status);
255
	spin_unlock_irqrestore(&ha->hardware_lock, flags);
L
Linus Torvalds 已提交
256 257 258 259 260 261 262 263 264 265

	return (IRQ_HANDLED);
}

/**
 * qla2x00_mbx_completion() - Process mailbox command completions.
 * @ha: SCSI driver HA context
 * @mb0: Mailbox0 register
 */
static void
266
qla2x00_mbx_completion(scsi_qla_host_t *vha, uint16_t mb0)
L
Linus Torvalds 已提交
267 268
{
	uint16_t	cnt;
269
	uint32_t	mboxes;
L
Linus Torvalds 已提交
270
	uint16_t __iomem *wptr;
271
	struct qla_hw_data *ha = vha->hw;
272
	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
L
Linus Torvalds 已提交
273

274 275 276
	/* Read all mbox registers? */
	mboxes = (1 << ha->mbx_count) - 1;
	if (!ha->mcp)
277
		ql_dbg(ql_dbg_async, vha, 0x5001, "MBX pointer ERROR.\n");
278 279 280
	else
		mboxes = ha->mcp->in_mb;

L
Linus Torvalds 已提交
281 282 283
	/* Load return mailbox registers. */
	ha->flags.mbox_int = 1;
	ha->mailbox_out[0] = mb0;
284
	mboxes >>= 1;
L
Linus Torvalds 已提交
285 286 287
	wptr = (uint16_t __iomem *)MAILBOX_REG(ha, reg, 1);

	for (cnt = 1; cnt < ha->mbx_count; cnt++) {
A
Andrew Vasquez 已提交
288
		if (IS_QLA2200(ha) && cnt == 8)
L
Linus Torvalds 已提交
289
			wptr = (uint16_t __iomem *)MAILBOX_REG(ha, reg, 8);
290
		if ((cnt == 4 || cnt == 5) && (mboxes & BIT_0))
L
Linus Torvalds 已提交
291
			ha->mailbox_out[cnt] = qla2x00_debounce_register(wptr);
292
		else if (mboxes & BIT_0)
L
Linus Torvalds 已提交
293
			ha->mailbox_out[cnt] = RD_REG_WORD(wptr);
A
Andrew Vasquez 已提交
294

L
Linus Torvalds 已提交
295
		wptr++;
296
		mboxes >>= 1;
L
Linus Torvalds 已提交
297 298 299
	}
}

300 301 302 303 304 305 306
static void
qla81xx_idc_event(scsi_qla_host_t *vha, uint16_t aen, uint16_t descr)
{
	static char *event[] =
		{ "Complete", "Request Notification", "Time Extension" };
	int rval;
	struct device_reg_24xx __iomem *reg24 = &vha->hw->iobase->isp24;
307
	struct device_reg_82xx __iomem *reg82 = &vha->hw->iobase->isp82;
308 309 310 311
	uint16_t __iomem *wptr;
	uint16_t cnt, timeout, mb[QLA_IDC_ACK_REGS];

	/* Seed data -- mailbox1 -> mailbox7. */
312 313 314 315 316 317 318
	if (IS_QLA81XX(vha->hw) || IS_QLA83XX(vha->hw))
		wptr = (uint16_t __iomem *)&reg24->mailbox1;
	else if (IS_QLA8044(vha->hw))
		wptr = (uint16_t __iomem *)&reg82->mailbox_out[1];
	else
		return;

319 320 321
	for (cnt = 0; cnt < QLA_IDC_ACK_REGS; cnt++, wptr++)
		mb[cnt] = RD_REG_WORD(wptr);

322
	ql_dbg(ql_dbg_async, vha, 0x5021,
323
	    "Inter-Driver Communication %s -- "
324 325 326
	    "%04x %04x %04x %04x %04x %04x %04x.\n",
	    event[aen & 0xff], mb[0], mb[1], mb[2], mb[3],
	    mb[4], mb[5], mb[6]);
327 328 329 330 331
	switch (aen) {
	/* Handle IDC Error completion case. */
	case MBA_IDC_COMPLETE:
		if (mb[1] >> 15) {
			vha->hw->flags.idc_compl_status = 1;
332
			if (vha->hw->notify_dcbx_comp && !vha->vp_idx)
333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357
				complete(&vha->hw->dcbx_comp);
		}
		break;

	case MBA_IDC_NOTIFY:
		/* Acknowledgement needed? [Notify && non-zero timeout]. */
		timeout = (descr >> 8) & 0xf;
		ql_dbg(ql_dbg_async, vha, 0x5022,
		    "%lu Inter-Driver Communication %s -- ACK timeout=%d.\n",
		    vha->host_no, event[aen & 0xff], timeout);

		if (!timeout)
			return;
		rval = qla2x00_post_idc_ack_work(vha, mb);
		if (rval != QLA_SUCCESS)
			ql_log(ql_log_warn, vha, 0x5023,
			    "IDC failed to post ACK.\n");
		break;
	case MBA_IDC_TIME_EXT:
		vha->hw->idc_extend_tmo = descr;
		ql_dbg(ql_dbg_async, vha, 0x5087,
		    "%lu Inter-Driver Communication %s -- "
		    "Extend timeout by=%d.\n",
		    vha->host_no, event[aen & 0xff], vha->hw->idc_extend_tmo);
		break;
358
	}
359 360
}

361
#define LS_UNKNOWN	2
362 363
const char *
qla2x00_get_link_speed_str(struct qla_hw_data *ha, uint16_t speed)
364
{
365 366
	static const char *const link_speeds[] = {
		"1", "2", "?", "4", "8", "16", "32", "10"
367
	};
368
#define	QLA_LAST_SPEED	7
369 370

	if (IS_QLA2100(ha) || IS_QLA2200(ha))
371 372
		return link_speeds[0];
	else if (speed == 0x13)
373 374
		return link_speeds[QLA_LAST_SPEED];
	else if (speed < QLA_LAST_SPEED)
375 376 377
		return link_speeds[speed];
	else
		return link_speeds[LS_UNKNOWN];
378 379
}

380
static void
381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436
qla83xx_handle_8200_aen(scsi_qla_host_t *vha, uint16_t *mb)
{
	struct qla_hw_data *ha = vha->hw;

	/*
	 * 8200 AEN Interpretation:
	 * mb[0] = AEN code
	 * mb[1] = AEN Reason code
	 * mb[2] = LSW of Peg-Halt Status-1 Register
	 * mb[6] = MSW of Peg-Halt Status-1 Register
	 * mb[3] = LSW of Peg-Halt Status-2 register
	 * mb[7] = MSW of Peg-Halt Status-2 register
	 * mb[4] = IDC Device-State Register value
	 * mb[5] = IDC Driver-Presence Register value
	 */
	ql_dbg(ql_dbg_async, vha, 0x506b, "AEN Code: mb[0] = 0x%x AEN reason: "
	    "mb[1] = 0x%x PH-status1: mb[2] = 0x%x PH-status1: mb[6] = 0x%x.\n",
	    mb[0], mb[1], mb[2], mb[6]);
	ql_dbg(ql_dbg_async, vha, 0x506c, "PH-status2: mb[3] = 0x%x "
	    "PH-status2: mb[7] = 0x%x Device-State: mb[4] = 0x%x "
	    "Drv-Presence: mb[5] = 0x%x.\n", mb[3], mb[7], mb[4], mb[5]);

	if (mb[1] & (IDC_PEG_HALT_STATUS_CHANGE | IDC_NIC_FW_REPORTED_FAILURE |
				IDC_HEARTBEAT_FAILURE)) {
		ha->flags.nic_core_hung = 1;
		ql_log(ql_log_warn, vha, 0x5060,
		    "83XX: F/W Error Reported: Check if reset required.\n");

		if (mb[1] & IDC_PEG_HALT_STATUS_CHANGE) {
			uint32_t protocol_engine_id, fw_err_code, err_level;

			/*
			 * IDC_PEG_HALT_STATUS_CHANGE interpretation:
			 *  - PEG-Halt Status-1 Register:
			 *	(LSW = mb[2], MSW = mb[6])
			 *	Bits 0-7   = protocol-engine ID
			 *	Bits 8-28  = f/w error code
			 *	Bits 29-31 = Error-level
			 *	    Error-level 0x1 = Non-Fatal error
			 *	    Error-level 0x2 = Recoverable Fatal error
			 *	    Error-level 0x4 = UnRecoverable Fatal error
			 *  - PEG-Halt Status-2 Register:
			 *	(LSW = mb[3], MSW = mb[7])
			 */
			protocol_engine_id = (mb[2] & 0xff);
			fw_err_code = (((mb[2] & 0xff00) >> 8) |
			    ((mb[6] & 0x1fff) << 8));
			err_level = ((mb[6] & 0xe000) >> 13);
			ql_log(ql_log_warn, vha, 0x5061, "PegHalt Status-1 "
			    "Register: protocol_engine_id=0x%x "
			    "fw_err_code=0x%x err_level=0x%x.\n",
			    protocol_engine_id, fw_err_code, err_level);
			ql_log(ql_log_warn, vha, 0x5062, "PegHalt Status-2 "
			    "Register: 0x%x%x.\n", mb[7], mb[3]);
			if (err_level == ERR_LEVEL_NON_FATAL) {
				ql_log(ql_log_warn, vha, 0x5063,
437
				    "Not a fatal error, f/w has recovered itself.\n");
438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456
			} else if (err_level == ERR_LEVEL_RECOVERABLE_FATAL) {
				ql_log(ql_log_fatal, vha, 0x5064,
				    "Recoverable Fatal error: Chip reset "
				    "required.\n");
				qla83xx_schedule_work(vha,
				    QLA83XX_NIC_CORE_RESET);
			} else if (err_level == ERR_LEVEL_UNRECOVERABLE_FATAL) {
				ql_log(ql_log_fatal, vha, 0x5065,
				    "Unrecoverable Fatal error: Set FAILED "
				    "state, reboot required.\n");
				qla83xx_schedule_work(vha,
				    QLA83XX_NIC_CORE_UNRECOVERABLE);
			}
		}

		if (mb[1] & IDC_NIC_FW_REPORTED_FAILURE) {
			uint16_t peg_fw_state, nw_interface_link_up;
			uint16_t nw_interface_signal_detect, sfp_status;
			uint16_t htbt_counter, htbt_monitor_enable;
457
			uint16_t sfp_additional_info, sfp_multirate;
458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496
			uint16_t sfp_tx_fault, link_speed, dcbx_status;

			/*
			 * IDC_NIC_FW_REPORTED_FAILURE interpretation:
			 *  - PEG-to-FC Status Register:
			 *	(LSW = mb[2], MSW = mb[6])
			 *	Bits 0-7   = Peg-Firmware state
			 *	Bit 8      = N/W Interface Link-up
			 *	Bit 9      = N/W Interface signal detected
			 *	Bits 10-11 = SFP Status
			 *	  SFP Status 0x0 = SFP+ transceiver not expected
			 *	  SFP Status 0x1 = SFP+ transceiver not present
			 *	  SFP Status 0x2 = SFP+ transceiver invalid
			 *	  SFP Status 0x3 = SFP+ transceiver present and
			 *	  valid
			 *	Bits 12-14 = Heartbeat Counter
			 *	Bit 15     = Heartbeat Monitor Enable
			 *	Bits 16-17 = SFP Additional Info
			 *	  SFP info 0x0 = Unregocnized transceiver for
			 *	  Ethernet
			 *	  SFP info 0x1 = SFP+ brand validation failed
			 *	  SFP info 0x2 = SFP+ speed validation failed
			 *	  SFP info 0x3 = SFP+ access error
			 *	Bit 18     = SFP Multirate
			 *	Bit 19     = SFP Tx Fault
			 *	Bits 20-22 = Link Speed
			 *	Bits 23-27 = Reserved
			 *	Bits 28-30 = DCBX Status
			 *	  DCBX Status 0x0 = DCBX Disabled
			 *	  DCBX Status 0x1 = DCBX Enabled
			 *	  DCBX Status 0x2 = DCBX Exchange error
			 *	Bit 31     = Reserved
			 */
			peg_fw_state = (mb[2] & 0x00ff);
			nw_interface_link_up = ((mb[2] & 0x0100) >> 8);
			nw_interface_signal_detect = ((mb[2] & 0x0200) >> 9);
			sfp_status = ((mb[2] & 0x0c00) >> 10);
			htbt_counter = ((mb[2] & 0x7000) >> 12);
			htbt_monitor_enable = ((mb[2] & 0x8000) >> 15);
497
			sfp_additional_info = (mb[6] & 0x0003);
498 499 500 501 502 503 504 505 506 507 508 509 510 511
			sfp_multirate = ((mb[6] & 0x0004) >> 2);
			sfp_tx_fault = ((mb[6] & 0x0008) >> 3);
			link_speed = ((mb[6] & 0x0070) >> 4);
			dcbx_status = ((mb[6] & 0x7000) >> 12);

			ql_log(ql_log_warn, vha, 0x5066,
			    "Peg-to-Fc Status Register:\n"
			    "peg_fw_state=0x%x, nw_interface_link_up=0x%x, "
			    "nw_interface_signal_detect=0x%x"
			    "\nsfp_statis=0x%x.\n ", peg_fw_state,
			    nw_interface_link_up, nw_interface_signal_detect,
			    sfp_status);
			ql_log(ql_log_warn, vha, 0x5067,
			    "htbt_counter=0x%x, htbt_monitor_enable=0x%x, "
512
			    "sfp_additional_info=0x%x, sfp_multirate=0x%x.\n ",
513
			    htbt_counter, htbt_monitor_enable,
514
			    sfp_additional_info, sfp_multirate);
515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534
			ql_log(ql_log_warn, vha, 0x5068,
			    "sfp_tx_fault=0x%x, link_state=0x%x, "
			    "dcbx_status=0x%x.\n", sfp_tx_fault, link_speed,
			    dcbx_status);

			qla83xx_schedule_work(vha, QLA83XX_NIC_CORE_RESET);
		}

		if (mb[1] & IDC_HEARTBEAT_FAILURE) {
			ql_log(ql_log_warn, vha, 0x5069,
			    "Heartbeat Failure encountered, chip reset "
			    "required.\n");

			qla83xx_schedule_work(vha, QLA83XX_NIC_CORE_RESET);
		}
	}

	if (mb[1] & IDC_DEVICE_STATE_CHANGE) {
		ql_log(ql_log_info, vha, 0x506a,
		    "IDC Device-State changed = 0x%x.\n", mb[4]);
535 536
		if (ha->flags.nic_core_reset_owner)
			return;
537 538 539 540
		qla83xx_schedule_work(vha, MBA_IDC_AEN);
	}
}

541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565
int
qla2x00_is_a_vp_did(scsi_qla_host_t *vha, uint32_t rscn_entry)
{
	struct qla_hw_data *ha = vha->hw;
	scsi_qla_host_t *vp;
	uint32_t vp_did;
	unsigned long flags;
	int ret = 0;

	if (!ha->num_vhosts)
		return ret;

	spin_lock_irqsave(&ha->vport_slock, flags);
	list_for_each_entry(vp, &ha->vp_list, list) {
		vp_did = vp->d_id.b24;
		if (vp_did == rscn_entry) {
			ret = 1;
			break;
		}
	}
	spin_unlock_irqrestore(&ha->vport_slock, flags);

	return ret;
}

566
fc_port_t *
567 568
qla2x00_find_fcport_by_loopid(scsi_qla_host_t *vha, uint16_t loop_id)
{
569 570 571 572 573 574 575 576
	fc_port_t *f, *tf;

	f = tf = NULL;
	list_for_each_entry_safe(f, tf, &vha->vp_fcports, list)
		if (f->loop_id == loop_id)
			return f;
	return NULL;
}
577

578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593
fc_port_t *
qla2x00_find_fcport_by_wwpn(scsi_qla_host_t *vha, u8 *wwpn, u8 incl_deleted)
{
	fc_port_t *f, *tf;

	f = tf = NULL;
	list_for_each_entry_safe(f, tf, &vha->vp_fcports, list) {
		if (memcmp(f->port_name, wwpn, WWN_SIZE) == 0) {
			if (incl_deleted)
				return f;
			else if (f->deleted == 0)
				return f;
		}
	}
	return NULL;
}
594

595 596 597 598 599 600 601 602 603 604 605 606 607 608 609
fc_port_t *
qla2x00_find_fcport_by_nportid(scsi_qla_host_t *vha, port_id_t *id,
	u8 incl_deleted)
{
	fc_port_t *f, *tf;

	f = tf = NULL;
	list_for_each_entry_safe(f, tf, &vha->vp_fcports, list) {
		if (f->d_id.b24 == id->b24) {
			if (incl_deleted)
				return f;
			else if (f->deleted == 0)
				return f;
		}
	}
610 611 612
	return NULL;
}

L
Linus Torvalds 已提交
613 614 615
/**
 * qla2x00_async_event() - Process aynchronous events.
 * @ha: SCSI driver HA context
616
 * @mb: Mailbox registers (0 - 3)
L
Linus Torvalds 已提交
617
 */
618
void
619
qla2x00_async_event(scsi_qla_host_t *vha, struct rsp_que *rsp, uint16_t *mb)
L
Linus Torvalds 已提交
620 621
{
	uint16_t	handle_cnt;
622
	uint16_t	cnt, mbx;
L
Linus Torvalds 已提交
623
	uint32_t	handles[5];
624
	struct qla_hw_data *ha = vha->hw;
625
	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
626
	struct device_reg_24xx __iomem *reg24 = &ha->iobase->isp24;
627
	struct device_reg_82xx __iomem *reg82 = &ha->iobase->isp82;
628
	uint32_t	rscn_entry, host_pid;
629
	unsigned long	flags;
630
	fc_port_t	*fcport = NULL;
L
Linus Torvalds 已提交
631 632 633

	/* Setup to process RIO completion. */
	handle_cnt = 0;
634
	if (IS_CNA_CAPABLE(ha))
635
		goto skip_rio;
L
Linus Torvalds 已提交
636 637
	switch (mb[0]) {
	case MBA_SCSI_COMPLETION:
638
		handles[0] = le32_to_cpu((uint32_t)((mb[2] << 16) | mb[1]));
L
Linus Torvalds 已提交
639 640 641
		handle_cnt = 1;
		break;
	case MBA_CMPLT_1_16BIT:
642
		handles[0] = mb[1];
L
Linus Torvalds 已提交
643 644 645 646
		handle_cnt = 1;
		mb[0] = MBA_SCSI_COMPLETION;
		break;
	case MBA_CMPLT_2_16BIT:
647 648
		handles[0] = mb[1];
		handles[1] = mb[2];
L
Linus Torvalds 已提交
649 650 651 652
		handle_cnt = 2;
		mb[0] = MBA_SCSI_COMPLETION;
		break;
	case MBA_CMPLT_3_16BIT:
653 654 655
		handles[0] = mb[1];
		handles[1] = mb[2];
		handles[2] = mb[3];
L
Linus Torvalds 已提交
656 657 658 659
		handle_cnt = 3;
		mb[0] = MBA_SCSI_COMPLETION;
		break;
	case MBA_CMPLT_4_16BIT:
660 661 662
		handles[0] = mb[1];
		handles[1] = mb[2];
		handles[2] = mb[3];
L
Linus Torvalds 已提交
663 664 665 666 667
		handles[3] = (uint32_t)RD_MAILBOX_REG(ha, reg, 6);
		handle_cnt = 4;
		mb[0] = MBA_SCSI_COMPLETION;
		break;
	case MBA_CMPLT_5_16BIT:
668 669 670
		handles[0] = mb[1];
		handles[1] = mb[2];
		handles[2] = mb[3];
L
Linus Torvalds 已提交
671 672 673 674 675 676
		handles[3] = (uint32_t)RD_MAILBOX_REG(ha, reg, 6);
		handles[4] = (uint32_t)RD_MAILBOX_REG(ha, reg, 7);
		handle_cnt = 5;
		mb[0] = MBA_SCSI_COMPLETION;
		break;
	case MBA_CMPLT_2_32BIT:
677
		handles[0] = le32_to_cpu((uint32_t)((mb[2] << 16) | mb[1]));
L
Linus Torvalds 已提交
678 679 680 681 682 683 684 685 686
		handles[1] = le32_to_cpu(
		    ((uint32_t)(RD_MAILBOX_REG(ha, reg, 7) << 16)) |
		    RD_MAILBOX_REG(ha, reg, 6));
		handle_cnt = 2;
		mb[0] = MBA_SCSI_COMPLETION;
		break;
	default:
		break;
	}
687
skip_rio:
L
Linus Torvalds 已提交
688 689
	switch (mb[0]) {
	case MBA_SCSI_COMPLETION:	/* Fast Post */
690
		if (!vha->flags.online)
L
Linus Torvalds 已提交
691 692 693
			break;

		for (cnt = 0; cnt < handle_cnt; cnt++)
694 695
			qla2x00_process_completed_request(vha, rsp->req,
				handles[cnt]);
L
Linus Torvalds 已提交
696 697 698
		break;

	case MBA_RESET:			/* Reset */
699 700
		ql_dbg(ql_dbg_async, vha, 0x5002,
		    "Asynchronous RESET.\n");
L
Linus Torvalds 已提交
701

702
		set_bit(RESET_MARKER_NEEDED, &vha->dpc_flags);
L
Linus Torvalds 已提交
703 704 705
		break;

	case MBA_SYSTEM_ERR:		/* System Error */
706
		mbx = (IS_QLA81XX(ha) || IS_QLA83XX(ha) || IS_QLA27XX(ha)) ?
707
			RD_REG_WORD(&reg24->mailbox7) : 0;
708
		ql_log(ql_log_warn, vha, 0x5003,
709 710
		    "ISP System Error - mbx1=%xh mbx2=%xh mbx3=%xh "
		    "mbx7=%xh.\n", mb[1], mb[2], mb[3], mbx);
L
Linus Torvalds 已提交
711

712
		ha->isp_ops->fw_dump(vha, 1);
713
		ha->flags.fw_init_done = 0;
714
		QLA_FW_STOPPED(ha);
L
Linus Torvalds 已提交
715

716
		if (IS_FWI2_CAPABLE(ha)) {
717
			if (mb[1] == 0 && mb[2] == 0) {
718
				ql_log(ql_log_fatal, vha, 0x5004,
719 720
				    "Unrecoverable Hardware Error: adapter "
				    "marked OFFLINE!\n");
721
				vha->flags.online = 0;
722
				vha->device_flags |= DFLG_DEV_FAILED;
723
			} else {
L
Lucas De Marchi 已提交
724
				/* Check to see if MPI timeout occurred */
725
				if ((mbx & MBX_3) && (ha->port_no == 0))
726 727 728
					set_bit(MPI_RESET_NEEDED,
					    &vha->dpc_flags);

729
				set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
730
			}
731
		} else if (mb[1] == 0) {
732
			ql_log(ql_log_fatal, vha, 0x5005,
L
Linus Torvalds 已提交
733 734
			    "Unrecoverable Hardware Error: adapter marked "
			    "OFFLINE!\n");
735
			vha->flags.online = 0;
736
			vha->device_flags |= DFLG_DEV_FAILED;
L
Linus Torvalds 已提交
737
		} else
738
			set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
L
Linus Torvalds 已提交
739 740 741
		break;

	case MBA_REQ_TRANSFER_ERR:	/* Request Transfer Error */
742 743
		ql_log(ql_log_warn, vha, 0x5006,
		    "ISP Request Transfer Error (%x).\n",  mb[1]);
L
Linus Torvalds 已提交
744

745
		set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
L
Linus Torvalds 已提交
746 747 748
		break;

	case MBA_RSP_TRANSFER_ERR:	/* Response Transfer Error */
749
		ql_log(ql_log_warn, vha, 0x5007,
750
		    "ISP Response Transfer Error (%x).\n", mb[1]);
L
Linus Torvalds 已提交
751

752
		set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
L
Linus Torvalds 已提交
753 754 755
		break;

	case MBA_WAKEUP_THRES:		/* Request Queue Wake-up */
756
		ql_dbg(ql_dbg_async, vha, 0x5008,
757 758
		    "Asynchronous WAKEUP_THRES (%x).\n", mb[1]);
		break;
L
Linus Torvalds 已提交
759

760
	case MBA_LOOP_INIT_ERR:
761
		ql_log(ql_log_warn, vha, 0x5090,
762 763 764
		    "LOOP INIT ERROR (%x).\n", mb[1]);
		ha->isp_ops->fw_dump(vha, 1);
		set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
765
		break;
766

L
Linus Torvalds 已提交
767
	case MBA_LIP_OCCURRED:		/* Loop Initialization Procedure */
768 769 770
		ha->flags.lip_ae = 1;
		ha->flags.n2n_ae = 0;

771
		ql_dbg(ql_dbg_async, vha, 0x5009,
772
		    "LIP occurred (%x).\n", mb[1]);
L
Linus Torvalds 已提交
773

774 775 776 777
		if (atomic_read(&vha->loop_state) != LOOP_DOWN) {
			atomic_set(&vha->loop_state, LOOP_DOWN);
			atomic_set(&vha->loop_down_timer, LOOP_DOWN_TIME);
			qla2x00_mark_all_devices_lost(vha, 1);
L
Linus Torvalds 已提交
778 779
		}

780 781 782
		if (vha->vp_idx) {
			atomic_set(&vha->vp_state, VP_FAILED);
			fc_vport_set_state(vha->fc_vport, FC_VPORT_FAILED);
783 784
		}

785 786
		set_bit(REGISTER_FC4_NEEDED, &vha->dpc_flags);
		set_bit(REGISTER_FDMI_NEEDED, &vha->dpc_flags);
L
Linus Torvalds 已提交
787

788 789
		vha->flags.management_server_logged_in = 0;
		qla2x00_post_aen_work(vha, FCH_EVT_LIP, mb[1]);
L
Linus Torvalds 已提交
790 791 792
		break;

	case MBA_LOOP_UP:		/* Loop Up Event */
793
		if (IS_QLA2100(ha) || IS_QLA2200(ha))
794
			ha->link_data_rate = PORT_SPEED_1GB;
795
		else
L
Linus Torvalds 已提交
796 797
			ha->link_data_rate = mb[1];

798
		ql_log(ql_log_info, vha, 0x500a,
799
		    "LOOP UP detected (%s Gbps).\n",
800
		    qla2x00_get_link_speed_str(ha, ha->link_data_rate));
L
Linus Torvalds 已提交
801

802 803
		vha->flags.management_server_logged_in = 0;
		qla2x00_post_aen_work(vha, FCH_EVT_LINKUP, ha->link_data_rate);
804 805 806 807 808

		if (AUTO_DETECT_SFP_SUPPORT(vha)) {
			set_bit(DETECT_SFP_CHANGE, &vha->dpc_flags);
			qla2xxx_wake_dpc(vha);
		}
L
Linus Torvalds 已提交
809 810 811
		break;

	case MBA_LOOP_DOWN:		/* Loop Down Event */
812
		SAVE_TOPO(ha);
813 814 815 816
		ha->flags.n2n_ae = 0;
		ha->flags.lip_ae = 0;
		ha->current_topology = 0;

817 818
		mbx = (IS_QLA81XX(ha) || IS_QLA8031(ha))
			? RD_REG_WORD(&reg24->mailbox4) : 0;
819 820
		mbx = (IS_P3P_TYPE(ha)) ? RD_REG_WORD(&reg82->mailbox_out[4])
			: mbx;
821
		ql_log(ql_log_info, vha, 0x500b,
822 823
		    "LOOP DOWN detected (%x %x %x %x).\n",
		    mb[1], mb[2], mb[3], mbx);
L
Linus Torvalds 已提交
824

825 826 827
		if (atomic_read(&vha->loop_state) != LOOP_DOWN) {
			atomic_set(&vha->loop_state, LOOP_DOWN);
			atomic_set(&vha->loop_down_timer, LOOP_DOWN_TIME);
828 829 830
			/*
			 * In case of loop down, restore WWPN from
			 * NVRAM in case of FA-WWPN capable ISP
831
			 * Restore for Physical Port only
832
			 */
833 834 835 836 837 838 839
			if (!vha->vp_idx) {
				if (ha->flags.fawwpn_enabled) {
					void *wwpn = ha->init_cb->port_name;
					memcpy(vha->port_name, wwpn, WWN_SIZE);
					fc_host_port_name(vha->host) =
					    wwn_to_u64(vha->port_name);
					ql_dbg(ql_dbg_init + ql_dbg_verbose,
840
					    vha, 0x00d8, "LOOP DOWN detected,"
841 842 843 844 845
					    "restore WWPN %016llx\n",
					    wwn_to_u64(vha->port_name));
				}

				clear_bit(VP_CONFIG_OK, &vha->vp_flags);
846 847
			}

848 849
			vha->device_flags |= DFLG_NO_CABLE;
			qla2x00_mark_all_devices_lost(vha, 1);
L
Linus Torvalds 已提交
850 851
		}

852 853 854
		if (vha->vp_idx) {
			atomic_set(&vha->vp_state, VP_FAILED);
			fc_vport_set_state(vha->fc_vport, FC_VPORT_FAILED);
855 856
		}

857
		vha->flags.management_server_logged_in = 0;
858
		ha->link_data_rate = PORT_SPEED_UNKNOWN;
859
		qla2x00_post_aen_work(vha, FCH_EVT_LINKDOWN, 0);
L
Linus Torvalds 已提交
860 861 862
		break;

	case MBA_LIP_RESET:		/* LIP reset occurred */
863
		ql_dbg(ql_dbg_async, vha, 0x500c,
864
		    "LIP reset occurred (%x).\n", mb[1]);
L
Linus Torvalds 已提交
865

866 867 868 869
		if (atomic_read(&vha->loop_state) != LOOP_DOWN) {
			atomic_set(&vha->loop_state, LOOP_DOWN);
			atomic_set(&vha->loop_down_timer, LOOP_DOWN_TIME);
			qla2x00_mark_all_devices_lost(vha, 1);
L
Linus Torvalds 已提交
870 871
		}

872 873 874
		if (vha->vp_idx) {
			atomic_set(&vha->vp_state, VP_FAILED);
			fc_vport_set_state(vha->fc_vport, FC_VPORT_FAILED);
875 876
		}

877
		set_bit(RESET_MARKER_NEEDED, &vha->dpc_flags);
L
Linus Torvalds 已提交
878 879

		ha->operating_mode = LOOP;
880 881
		vha->flags.management_server_logged_in = 0;
		qla2x00_post_aen_work(vha, FCH_EVT_LIPRESET, mb[1]);
L
Linus Torvalds 已提交
882 883
		break;

884
	/* case MBA_DCBX_COMPLETE: */
L
Linus Torvalds 已提交
885
	case MBA_POINT_TO_POINT:	/* Point-to-Point */
886 887 888
		ha->flags.lip_ae = 0;
		ha->flags.n2n_ae = 1;

L
Linus Torvalds 已提交
889 890 891
		if (IS_QLA2100(ha))
			break;

892
		if (IS_CNA_CAPABLE(ha)) {
893 894 895
			ql_dbg(ql_dbg_async, vha, 0x500d,
			    "DCBX Completed -- %04x %04x %04x.\n",
			    mb[1], mb[2], mb[3]);
896
			if (ha->notify_dcbx_comp && !vha->vp_idx)
897 898 899
				complete(&ha->dcbx_comp);

		} else
900 901
			ql_dbg(ql_dbg_async, vha, 0x500e,
			    "Asynchronous P2P MODE received.\n");
L
Linus Torvalds 已提交
902 903 904 905 906

		/*
		 * Until there's a transition from loop down to loop up, treat
		 * this as loop down only.
		 */
907 908 909 910
		if (atomic_read(&vha->loop_state) != LOOP_DOWN) {
			atomic_set(&vha->loop_state, LOOP_DOWN);
			if (!atomic_read(&vha->loop_down_timer))
				atomic_set(&vha->loop_down_timer,
L
Linus Torvalds 已提交
911
				    LOOP_DOWN_TIME);
912
			qla2x00_mark_all_devices_lost(vha, 1);
L
Linus Torvalds 已提交
913 914
		}

915 916 917
		if (vha->vp_idx) {
			atomic_set(&vha->vp_state, VP_FAILED);
			fc_vport_set_state(vha->fc_vport, FC_VPORT_FAILED);
918 919
		}

920 921 922 923 924
		if (!(test_bit(ABORT_ISP_ACTIVE, &vha->dpc_flags)))
			set_bit(RESET_MARKER_NEEDED, &vha->dpc_flags);

		set_bit(REGISTER_FC4_NEEDED, &vha->dpc_flags);
		set_bit(REGISTER_FDMI_NEEDED, &vha->dpc_flags);
925

926
		vha->flags.management_server_logged_in = 0;
L
Linus Torvalds 已提交
927 928 929 930 931 932
		break;

	case MBA_CHG_IN_CONNECTION:	/* Change in connection mode */
		if (IS_QLA2100(ha))
			break;

933
		ql_dbg(ql_dbg_async, vha, 0x500f,
L
Linus Torvalds 已提交
934 935
		    "Configuration change detected: value=%x.\n", mb[1]);

936 937 938 939
		if (atomic_read(&vha->loop_state) != LOOP_DOWN) {
			atomic_set(&vha->loop_state, LOOP_DOWN);
			if (!atomic_read(&vha->loop_down_timer))
				atomic_set(&vha->loop_down_timer,
L
Linus Torvalds 已提交
940
				    LOOP_DOWN_TIME);
941
			qla2x00_mark_all_devices_lost(vha, 1);
L
Linus Torvalds 已提交
942 943
		}

944 945 946
		if (vha->vp_idx) {
			atomic_set(&vha->vp_state, VP_FAILED);
			fc_vport_set_state(vha->fc_vport, FC_VPORT_FAILED);
947 948
		}

949 950
		set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
		set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
L
Linus Torvalds 已提交
951 952 953
		break;

	case MBA_PORT_UPDATE:		/* Port database update */
954 955 956 957 958 959 960 961 962 963 964 965 966 967 968
		/*
		 * Handle only global and vn-port update events
		 *
		 * Relevant inputs:
		 * mb[1] = N_Port handle of changed port
		 * OR 0xffff for global event
		 * mb[2] = New login state
		 * 7 = Port logged out
		 * mb[3] = LSB is vp_idx, 0xff = all vps
		 *
		 * Skip processing if:
		 *       Event is global, vp_idx is NOT all vps,
		 *           vp_idx does not match
		 *       Event is not global, vp_idx does not match
		 */
969 970 971 972
		if (IS_QLA2XXX_MIDTYPE(ha) &&
		    ((mb[1] == 0xffff && (mb[3] & 0xff) != 0xff) ||
			(mb[1] != 0xffff)) && vha->vp_idx != (mb[3] & 0xff))
			break;
973

974
		if (mb[2] == 0x7) {
975
			ql_dbg(ql_dbg_async, vha, 0x5010,
976 977
			    "Port %s %04x %04x %04x.\n",
			    mb[1] == 0xffff ? "unavailable" : "logout",
978
			    mb[1], mb[2], mb[3]);
979 980 981 982

			if (mb[1] == 0xffff)
				goto global_port_update;

983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999
			if (mb[1] == NPH_SNS_LID(ha)) {
				set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
				set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
				break;
			}

			/* use handle_cnt for loop id/nport handle */
			if (IS_FWI2_CAPABLE(ha))
				handle_cnt = NPH_SNS;
			else
				handle_cnt = SIMPLE_NAME_SERVER;
			if (mb[1] == handle_cnt) {
				set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
				set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
				break;
			}

1000 1001 1002 1003 1004 1005 1006 1007 1008
			/* Port logout */
			fcport = qla2x00_find_fcport_by_loopid(vha, mb[1]);
			if (!fcport)
				break;
			if (atomic_read(&fcport->state) != FCS_ONLINE)
				break;
			ql_dbg(ql_dbg_async, vha, 0x508a,
			    "Marking port lost loopid=%04x portid=%06x.\n",
			    fcport->loop_id, fcport->d_id.b24);
1009 1010 1011 1012 1013
			if (qla_ini_mode_enabled(vha)) {
				qla2x00_mark_device_lost(fcport->vha, fcport, 1, 1);
				fcport->logout_on_delete = 0;
				qlt_schedule_sess_for_deletion_lock(fcport);
			}
1014 1015 1016
			break;

global_port_update:
1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028
			if (atomic_read(&vha->loop_state) != LOOP_DOWN) {
				atomic_set(&vha->loop_state, LOOP_DOWN);
				atomic_set(&vha->loop_down_timer,
				    LOOP_DOWN_TIME);
				vha->device_flags |= DFLG_NO_CABLE;
				qla2x00_mark_all_devices_lost(vha, 1);
			}

			if (vha->vp_idx) {
				atomic_set(&vha->vp_state, VP_FAILED);
				fc_vport_set_state(vha->fc_vport,
				    FC_VPORT_FAILED);
1029
				qla2x00_mark_all_devices_lost(vha, 1);
1030 1031 1032 1033 1034 1035 1036
			}

			vha->flags.management_server_logged_in = 0;
			ha->link_data_rate = PORT_SPEED_UNKNOWN;
			break;
		}

L
Linus Torvalds 已提交
1037
		/*
1038
		 * If PORT UPDATE is global (received LIP_OCCURRED/LIP_RESET
L
Linus Torvalds 已提交
1039 1040 1041
		 * event etc. earlier indicating loop is down) then process
		 * it.  Otherwise ignore it and Wait for RSCN to come in.
		 */
1042
		atomic_set(&vha->loop_down_timer, 0);
1043
		if (atomic_read(&vha->loop_state) != LOOP_DOWN &&
1044
			!ha->flags.n2n_ae  &&
1045
		    atomic_read(&vha->loop_state) != LOOP_DEAD) {
1046 1047 1048
			ql_dbg(ql_dbg_async, vha, 0x5011,
			    "Asynchronous PORT UPDATE ignored %04x/%04x/%04x.\n",
			    mb[1], mb[2], mb[3]);
1049 1050

			qlt_async_event(mb[0], vha, mb);
L
Linus Torvalds 已提交
1051 1052 1053
			break;
		}

1054 1055 1056
		ql_dbg(ql_dbg_async, vha, 0x5012,
		    "Port database changed %04x %04x %04x.\n",
		    mb[1], mb[2], mb[3]);
L
Linus Torvalds 已提交
1057 1058 1059 1060

		/*
		 * Mark all devices as missing so we will login again.
		 */
1061
		atomic_set(&vha->loop_state, LOOP_UP);
L
Linus Torvalds 已提交
1062

1063 1064
		set_bit(LOOP_RESYNC_NEEDED, &vha->dpc_flags);
		set_bit(LOCAL_LOOP_UPDATE, &vha->dpc_flags);
1065
		set_bit(VP_CONFIG_OK, &vha->vp_flags);
1066 1067

		qlt_async_event(mb[0], vha, mb);
L
Linus Torvalds 已提交
1068 1069 1070
		break;

	case MBA_RSCN_UPDATE:		/* State Change Registration */
1071
		/* Check if the Vport has issued a SCR */
1072
		if (vha->vp_idx && test_bit(VP_SCR_NEEDED, &vha->vp_flags))
1073 1074
			break;
		/* Only handle SCNs for our Vport index. */
1075
		if (ha->flags.npiv_supported && vha->vp_idx != (mb[3] & 0xff))
1076
			break;
1077

1078 1079 1080
		ql_dbg(ql_dbg_async, vha, 0x5013,
		    "RSCN database changed -- %04x %04x %04x.\n",
		    mb[1], mb[2], mb[3]);
L
Linus Torvalds 已提交
1081

1082
		rscn_entry = ((mb[1] & 0xff) << 16) | mb[2];
1083 1084
		host_pid = (vha->d_id.b.domain << 16) | (vha->d_id.b.area << 8)
				| vha->d_id.b.al_pa;
L
Linus Torvalds 已提交
1085
		if (rscn_entry == host_pid) {
1086 1087 1088
			ql_dbg(ql_dbg_async, vha, 0x5014,
			    "Ignoring RSCN update to local host "
			    "port ID (%06x).\n", host_pid);
L
Linus Torvalds 已提交
1089 1090 1091
			break;
		}

1092 1093
		/* Ignore reserved bits from RSCN-payload. */
		rscn_entry = ((mb[1] & 0x3ff) << 16) | mb[2];
L
Linus Torvalds 已提交
1094

1095 1096 1097 1098
		/* Skip RSCNs for virtual ports on the same physical port */
		if (qla2x00_is_a_vp_did(vha, rscn_entry))
			break;

1099 1100
		atomic_set(&vha->loop_down_timer, 0);
		vha->flags.management_server_logged_in = 0;
1101 1102
		{
			struct event_arg ea;
L
Linus Torvalds 已提交
1103

1104 1105 1106
			memset(&ea, 0, sizeof(ea));
			ea.event = FCME_RSCN;
			ea.id.b24 = rscn_entry;
1107
			ea.id.b.rsvd_1 = rscn_entry >> 24;
1108
			qla2x00_fcport_event_handler(vha, &ea);
1109
			qla2x00_post_aen_work(vha, FCH_EVT_RSCN, rscn_entry);
1110
		}
L
Linus Torvalds 已提交
1111 1112 1113
		break;
	/* case MBA_RIO_RESPONSE: */
	case MBA_ZIO_RESPONSE:
1114 1115
		ql_dbg(ql_dbg_async, vha, 0x5015,
		    "[R|Z]IO update completion.\n");
L
Linus Torvalds 已提交
1116

1117
		if (IS_FWI2_CAPABLE(ha))
1118
			qla24xx_process_response_queue(vha, rsp);
1119
		else
1120
			qla2x00_process_response_queue(rsp);
L
Linus Torvalds 已提交
1121
		break;
1122 1123

	case MBA_DISCARD_RND_FRAME:
1124 1125 1126
		ql_dbg(ql_dbg_async, vha, 0x5016,
		    "Discard RND Frame -- %04x %04x %04x.\n",
		    mb[1], mb[2], mb[3]);
1127
		break;
1128 1129

	case MBA_TRACE_NOTIFICATION:
1130 1131
		ql_dbg(ql_dbg_async, vha, 0x5017,
		    "Trace Notification -- %04x %04x.\n", mb[1], mb[2]);
1132
		break;
1133 1134

	case MBA_ISP84XX_ALERT:
1135 1136 1137
		ql_dbg(ql_dbg_async, vha, 0x5018,
		    "ISP84XX Alert Notification -- %04x %04x %04x.\n",
		    mb[1], mb[2], mb[3]);
1138 1139 1140 1141

		spin_lock_irqsave(&ha->cs84xx->access_lock, flags);
		switch (mb[1]) {
		case A84_PANIC_RECOVERY:
1142 1143 1144
			ql_log(ql_log_info, vha, 0x5019,
			    "Alert 84XX: panic recovery %04x %04x.\n",
			    mb[2], mb[3]);
1145 1146 1147
			break;
		case A84_OP_LOGIN_COMPLETE:
			ha->cs84xx->op_fw_version = mb[3] << 16 | mb[2];
1148 1149 1150
			ql_log(ql_log_info, vha, 0x501a,
			    "Alert 84XX: firmware version %x.\n",
			    ha->cs84xx->op_fw_version);
1151 1152 1153
			break;
		case A84_DIAG_LOGIN_COMPLETE:
			ha->cs84xx->diag_fw_version = mb[3] << 16 | mb[2];
1154 1155 1156
			ql_log(ql_log_info, vha, 0x501b,
			    "Alert 84XX: diagnostic firmware version %x.\n",
			    ha->cs84xx->diag_fw_version);
1157 1158 1159 1160
			break;
		case A84_GOLD_LOGIN_COMPLETE:
			ha->cs84xx->diag_fw_version = mb[3] << 16 | mb[2];
			ha->cs84xx->fw_update = 1;
1161 1162 1163
			ql_log(ql_log_info, vha, 0x501c,
			    "Alert 84XX: gold firmware version %x.\n",
			    ha->cs84xx->gold_fw_version);
1164 1165
			break;
		default:
1166 1167
			ql_log(ql_log_warn, vha, 0x501d,
			    "Alert 84xx: Invalid Alert %04x %04x %04x.\n",
1168 1169 1170 1171
			    mb[1], mb[2], mb[3]);
		}
		spin_unlock_irqrestore(&ha->cs84xx->access_lock, flags);
		break;
1172
	case MBA_DCBX_START:
1173 1174 1175
		ql_dbg(ql_dbg_async, vha, 0x501e,
		    "DCBX Started -- %04x %04x %04x.\n",
		    mb[1], mb[2], mb[3]);
1176 1177
		break;
	case MBA_DCBX_PARAM_UPDATE:
1178 1179 1180
		ql_dbg(ql_dbg_async, vha, 0x501f,
		    "DCBX Parameters Updated -- %04x %04x %04x.\n",
		    mb[1], mb[2], mb[3]);
1181 1182
		break;
	case MBA_FCF_CONF_ERR:
1183 1184 1185
		ql_dbg(ql_dbg_async, vha, 0x5020,
		    "FCF Configuration Error -- %04x %04x %04x.\n",
		    mb[1], mb[2], mb[3]);
1186 1187
		break;
	case MBA_IDC_NOTIFY:
1188
		if (IS_QLA8031(vha->hw) || IS_QLA8044(ha)) {
1189 1190 1191 1192
			mb[4] = RD_REG_WORD(&reg24->mailbox4);
			if (((mb[2] & 0x7fff) == MBC_PORT_RESET ||
			    (mb[2] & 0x7fff) == MBC_SET_PORT_CONFIG) &&
			    (mb[4] & INTERNAL_LOOPBACK_MASK) != 0) {
1193
				set_bit(ISP_QUIESCE_NEEDED, &vha->dpc_flags);
1194 1195 1196 1197 1198 1199
				/*
				 * Extend loop down timer since port is active.
				 */
				if (atomic_read(&vha->loop_state) == LOOP_DOWN)
					atomic_set(&vha->loop_down_timer,
					    LOOP_DOWN_TIME);
1200 1201
				qla2xxx_wake_dpc(vha);
			}
1202
		}
1203
		/* fall through */
1204
	case MBA_IDC_COMPLETE:
1205
		if (ha->notify_lb_portup_comp && !vha->vp_idx)
1206 1207
			complete(&ha->lb_portup_comp);
		/* Fallthru */
1208
	case MBA_IDC_TIME_EXT:
1209 1210
		if (IS_QLA81XX(vha->hw) || IS_QLA8031(vha->hw) ||
		    IS_QLA8044(ha))
1211 1212 1213 1214 1215 1216 1217 1218 1219
			qla81xx_idc_event(vha, mb[0], mb[1]);
		break;

	case MBA_IDC_AEN:
		mb[4] = RD_REG_WORD(&reg24->mailbox4);
		mb[5] = RD_REG_WORD(&reg24->mailbox5);
		mb[6] = RD_REG_WORD(&reg24->mailbox6);
		mb[7] = RD_REG_WORD(&reg24->mailbox7);
		qla83xx_handle_8200_aen(vha, mb);
1220
		break;
1221

1222 1223
	case MBA_DPORT_DIAGNOSTICS:
		ql_dbg(ql_dbg_async, vha, 0x5052,
1224
		    "D-Port Diagnostics: %04x result=%s\n",
1225
		    mb[0],
1226
		    mb[1] == 0 ? "start" :
1227 1228
		    mb[1] == 1 ? "done (pass)" :
		    mb[1] == 2 ? "done (error)" : "other");
1229 1230
		break;

1231 1232 1233 1234 1235 1236 1237
	case MBA_TEMPERATURE_ALERT:
		ql_dbg(ql_dbg_async, vha, 0x505e,
		    "TEMPERATURE ALERT: %04x %04x %04x\n", mb[1], mb[2], mb[3]);
		if (mb[1] == 0x12)
			schedule_work(&ha->board_disable);
		break;

1238 1239 1240 1241 1242
	case MBA_TRANS_INSERT:
		ql_dbg(ql_dbg_async, vha, 0x5091,
		    "Transceiver Insertion: %04x\n", mb[1]);
		break;

1243 1244 1245 1246
	default:
		ql_dbg(ql_dbg_async, vha, 0x5057,
		    "Unknown AEN:%04x %04x %04x %04x\n",
		    mb[0], mb[1], mb[2], mb[3]);
L
Linus Torvalds 已提交
1247
	}
1248

1249 1250
	qlt_async_event(mb[0], vha, mb);

1251
	if (!vha->vp_idx && ha->num_vhosts)
1252
		qla2x00_alert_all_vps(rsp, mb);
L
Linus Torvalds 已提交
1253 1254 1255 1256 1257 1258 1259
}

/**
 * qla2x00_process_completed_request() - Process a Fast Post response.
 * @ha: SCSI driver HA context
 * @index: SRB index
 */
1260
void
1261
qla2x00_process_completed_request(struct scsi_qla_host *vha,
1262
				  struct req_que *req, uint32_t index)
L
Linus Torvalds 已提交
1263 1264
{
	srb_t *sp;
1265
	struct qla_hw_data *ha = vha->hw;
L
Linus Torvalds 已提交
1266 1267

	/* Validate handle. */
1268
	if (index >= req->num_outstanding_cmds) {
1269 1270
		ql_log(ql_log_warn, vha, 0x3014,
		    "Invalid SCSI command index (%x).\n", index);
L
Linus Torvalds 已提交
1271

1272
		if (IS_P3P_TYPE(ha))
1273 1274 1275
			set_bit(FCOE_CTX_RESET_NEEDED, &vha->dpc_flags);
		else
			set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
L
Linus Torvalds 已提交
1276 1277 1278
		return;
	}

1279
	sp = req->outstanding_cmds[index];
L
Linus Torvalds 已提交
1280 1281
	if (sp) {
		/* Free outstanding command slot. */
1282
		req->outstanding_cmds[index] = NULL;
L
Linus Torvalds 已提交
1283 1284

		/* Save ISP completion status */
1285
		sp->done(sp, DID_OK << 16);
L
Linus Torvalds 已提交
1286
	} else {
1287
		ql_log(ql_log_warn, vha, 0x3016, "Invalid SCSI SRB.\n");
L
Linus Torvalds 已提交
1288

1289
		if (IS_P3P_TYPE(ha))
1290 1291 1292
			set_bit(FCOE_CTX_RESET_NEEDED, &vha->dpc_flags);
		else
			set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
L
Linus Torvalds 已提交
1293 1294 1295
	}
}

1296
srb_t *
1297 1298 1299 1300 1301 1302 1303 1304 1305
qla2x00_get_sp_from_handle(scsi_qla_host_t *vha, const char *func,
    struct req_que *req, void *iocb)
{
	struct qla_hw_data *ha = vha->hw;
	sts_entry_t *pkt = iocb;
	srb_t *sp = NULL;
	uint16_t index;

	index = LSW(pkt->handle);
1306
	if (index >= req->num_outstanding_cmds) {
1307
		ql_log(ql_log_warn, vha, 0x5031,
1308 1309
			   "Invalid command index (%x) type %8ph.\n",
			   index, iocb);
1310
		if (IS_P3P_TYPE(ha))
1311 1312 1313
			set_bit(FCOE_CTX_RESET_NEEDED, &vha->dpc_flags);
		else
			set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
1314 1315 1316 1317
		goto done;
	}
	sp = req->outstanding_cmds[index];
	if (!sp) {
1318 1319
		ql_log(ql_log_warn, vha, 0x5032,
		    "Invalid completion handle (%x) -- timed-out.\n", index);
1320 1321 1322
		return sp;
	}
	if (sp->handle != index) {
1323 1324
		ql_log(ql_log_warn, vha, 0x5033,
		    "SRB handle (%x) mismatch %x.\n", sp->handle, index);
1325 1326
		return NULL;
	}
1327

1328
	req->outstanding_cmds[index] = NULL;
1329

1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341
done:
	return sp;
}

static void
qla2x00_mbx_iocb_entry(scsi_qla_host_t *vha, struct req_que *req,
    struct mbx_entry *mbx)
{
	const char func[] = "MBX-IOCB";
	const char *type;
	fc_port_t *fcport;
	srb_t *sp;
1342
	struct srb_iocb *lio;
1343
	uint16_t *data;
1344
	uint16_t status;
1345 1346 1347 1348 1349

	sp = qla2x00_get_sp_from_handle(vha, func, req, mbx);
	if (!sp)
		return;

1350 1351
	lio = &sp->u.iocb_cmd;
	type = sp->name;
1352
	fcport = sp->fcport;
1353
	data = lio->u.logio.data;
1354

1355
	data[0] = MBS_COMMAND_ERROR;
1356
	data[1] = lio->u.logio.flags & SRB_LOGIN_RETRIED ?
1357
	    QLA_LOGIO_LOGIN_RETRIED : 0;
1358
	if (mbx->entry_status) {
1359
		ql_dbg(ql_dbg_async, vha, 0x5043,
1360
		    "Async-%s error entry - hdl=%x portid=%02x%02x%02x "
1361
		    "entry-status=%x status=%x state-flag=%x "
1362 1363
		    "status-flags=%x.\n", type, sp->handle,
		    fcport->d_id.b.domain, fcport->d_id.b.area,
1364 1365
		    fcport->d_id.b.al_pa, mbx->entry_status,
		    le16_to_cpu(mbx->status), le16_to_cpu(mbx->state_flags),
1366
		    le16_to_cpu(mbx->status_flags));
1367

1368
		ql_dump_buffer(ql_dbg_async + ql_dbg_buffer, vha, 0x5029,
1369
		    (uint8_t *)mbx, sizeof(*mbx));
1370

1371
		goto logio_done;
1372 1373
	}

1374
	status = le16_to_cpu(mbx->status);
1375
	if (status == 0x30 && sp->type == SRB_LOGIN_CMD &&
1376 1377 1378
	    le16_to_cpu(mbx->mb0) == MBS_COMMAND_COMPLETE)
		status = 0;
	if (!status && le16_to_cpu(mbx->mb0) == MBS_COMMAND_COMPLETE) {
1379
		ql_dbg(ql_dbg_async, vha, 0x5045,
1380 1381 1382 1383
		    "Async-%s complete - hdl=%x portid=%02x%02x%02x mbx1=%x.\n",
		    type, sp->handle, fcport->d_id.b.domain,
		    fcport->d_id.b.area, fcport->d_id.b.al_pa,
		    le16_to_cpu(mbx->mb1));
1384 1385

		data[0] = MBS_COMMAND_COMPLETE;
1386
		if (sp->type == SRB_LOGIN_CMD) {
1387 1388 1389
			fcport->port_type = FCT_TARGET;
			if (le16_to_cpu(mbx->mb1) & BIT_0)
				fcport->port_type = FCT_INITIATOR;
1390
			else if (le16_to_cpu(mbx->mb1) & BIT_1)
1391
				fcport->flags |= FCF_FCP2_DEVICE;
1392
		}
1393
		goto logio_done;
1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407
	}

	data[0] = le16_to_cpu(mbx->mb0);
	switch (data[0]) {
	case MBS_PORT_ID_USED:
		data[1] = le16_to_cpu(mbx->mb1);
		break;
	case MBS_LOOP_ID_USED:
		break;
	default:
		data[0] = MBS_COMMAND_ERROR;
		break;
	}

1408
	ql_log(ql_log_warn, vha, 0x5046,
1409 1410 1411 1412
	    "Async-%s failed - hdl=%x portid=%02x%02x%02x status=%x "
	    "mb0=%x mb1=%x mb2=%x mb6=%x mb7=%x.\n", type, sp->handle,
	    fcport->d_id.b.domain, fcport->d_id.b.area, fcport->d_id.b.al_pa,
	    status, le16_to_cpu(mbx->mb0), le16_to_cpu(mbx->mb1),
1413
	    le16_to_cpu(mbx->mb2), le16_to_cpu(mbx->mb6),
1414
	    le16_to_cpu(mbx->mb7));
1415

1416
logio_done:
1417
	sp->done(sp, 0);
1418 1419
}

1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441
static void
qla24xx_mbx_iocb_entry(scsi_qla_host_t *vha, struct req_que *req,
    struct mbx_24xx_entry *pkt)
{
	const char func[] = "MBX-IOCB2";
	srb_t *sp;
	struct srb_iocb *si;
	u16 sz, i;
	int res;

	sp = qla2x00_get_sp_from_handle(vha, func, req, pkt);
	if (!sp)
		return;

	si = &sp->u.iocb_cmd;
	sz = min(ARRAY_SIZE(pkt->mb), ARRAY_SIZE(sp->u.iocb_cmd.u.mbx.in_mb));

	for (i = 0; i < sz; i++)
		si->u.mbx.in_mb[i] = le16_to_cpu(pkt->mb[i]);

	res = (si->u.mbx.in_mb[0] & MBS_MASK);

1442
	sp->done(sp, res);
1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459
}

static void
qla24xxx_nack_iocb_entry(scsi_qla_host_t *vha, struct req_que *req,
    struct nack_to_isp *pkt)
{
	const char func[] = "nack";
	srb_t *sp;
	int res = 0;

	sp = qla2x00_get_sp_from_handle(vha, func, req, pkt);
	if (!sp)
		return;

	if (pkt->u.isp2x.status != cpu_to_le16(NOTIFY_ACK_SUCCESS))
		res = QLA_FUNCTION_FAILED;

1460
	sp->done(sp, res);
1461 1462
}

1463 1464 1465 1466 1467 1468 1469
static void
qla2x00_ct_entry(scsi_qla_host_t *vha, struct req_que *req,
    sts_entry_t *pkt, int iocb_type)
{
	const char func[] = "CT_IOCB";
	const char *type;
	srb_t *sp;
1470
	struct bsg_job *bsg_job;
1471
	struct fc_bsg_reply *bsg_reply;
1472
	uint16_t comp_status;
1473
	int res = 0;
1474 1475 1476 1477 1478

	sp = qla2x00_get_sp_from_handle(vha, func, req, pkt);
	if (!sp)
		return;

1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529
	switch (sp->type) {
	case SRB_CT_CMD:
	    bsg_job = sp->u.bsg_job;
	    bsg_reply = bsg_job->reply;

	    type = "ct pass-through";

	    comp_status = le16_to_cpu(pkt->comp_status);

	    /*
	     * return FC_CTELS_STATUS_OK and leave the decoding of the ELS/CT
	     * fc payload  to the caller
	     */
	    bsg_reply->reply_data.ctels_reply.status = FC_CTELS_STATUS_OK;
	    bsg_job->reply_len = sizeof(struct fc_bsg_reply);

	    if (comp_status != CS_COMPLETE) {
		    if (comp_status == CS_DATA_UNDERRUN) {
			    res = DID_OK << 16;
			    bsg_reply->reply_payload_rcv_len =
				le16_to_cpu(((sts_entry_t *)pkt)->rsp_info_len);

			    ql_log(ql_log_warn, vha, 0x5048,
				"CT pass-through-%s error comp_status=0x%x total_byte=0x%x.\n",
				type, comp_status,
				bsg_reply->reply_payload_rcv_len);
		    } else {
			    ql_log(ql_log_warn, vha, 0x5049,
				"CT pass-through-%s error comp_status=0x%x.\n",
				type, comp_status);
			    res = DID_ERROR << 16;
			    bsg_reply->reply_payload_rcv_len = 0;
		    }
		    ql_dump_buffer(ql_dbg_async + ql_dbg_buffer, vha, 0x5035,
			(uint8_t *)pkt, sizeof(*pkt));
	    } else {
		    res = DID_OK << 16;
		    bsg_reply->reply_payload_rcv_len =
			bsg_job->reply_payload.payload_len;
		    bsg_job->reply_len = 0;
	    }
	    break;
	case SRB_CT_PTHRU_CMD:
	    /*
	     * borrowing sts_entry_24xx.comp_status.
	     * same location as ct_entry_24xx.comp_status
	     */
	     res = qla2x00_chk_ms_status(vha, (ms_iocb_entry_t *)pkt,
		 (struct ct_sns_rsp *)sp->u.iocb_cmd.u.ctarg.rsp,
		 sp->name);
	     break;
1530 1531
	}

1532
	sp->done(sp, res);
1533 1534
}

1535 1536 1537 1538 1539 1540 1541
static void
qla24xx_els_ct_entry(scsi_qla_host_t *vha, struct req_que *req,
    struct sts_entry_24xx *pkt, int iocb_type)
{
	const char func[] = "ELS_CT_IOCB";
	const char *type;
	srb_t *sp;
1542
	struct bsg_job *bsg_job;
1543
	struct fc_bsg_reply *bsg_reply;
1544 1545
	uint16_t comp_status;
	uint32_t fw_status[3];
1546
	int res;
1547
	struct srb_iocb *els;
1548 1549 1550 1551 1552 1553

	sp = qla2x00_get_sp_from_handle(vha, func, req, pkt);
	if (!sp)
		return;

	type = NULL;
1554
	switch (sp->type) {
1555 1556 1557 1558 1559 1560 1561
	case SRB_ELS_CMD_RPT:
	case SRB_ELS_CMD_HST:
		type = "els";
		break;
	case SRB_CT_CMD:
		type = "ct pass-through";
		break;
1562 1563
	case SRB_ELS_DCMD:
		type = "Driver ELS logo";
1564 1565 1566 1567 1568 1569 1570 1571
		if (iocb_type != ELS_IOCB_TYPE) {
			ql_dbg(ql_dbg_user, vha, 0x5047,
			    "Completing %s: (%p) type=%d.\n",
			    type, sp, sp->type);
			sp->done(sp, 0);
			return;
		}
		break;
1572 1573 1574 1575
	case SRB_CT_PTHRU_CMD:
		/* borrowing sts_entry_24xx.comp_status.
		   same location as ct_entry_24xx.comp_status
		 */
1576
		res = qla2x00_chk_ms_status(sp->vha, (ms_iocb_entry_t *)pkt,
1577 1578
			(struct ct_sns_rsp *)sp->u.iocb_cmd.u.ctarg.rsp,
			sp->name);
1579
		sp->done(sp, res);
1580
		return;
1581
	default:
1582
		ql_dbg(ql_dbg_user, vha, 0x503e,
1583
		    "Unrecognized SRB: (%p) type=%d.\n", sp, sp->type);
1584 1585 1586 1587 1588 1589 1590
		return;
	}

	comp_status = fw_status[0] = le16_to_cpu(pkt->comp_status);
	fw_status[1] = le16_to_cpu(((struct els_sts_entry_24xx*)pkt)->error_subcode_1);
	fw_status[2] = le16_to_cpu(((struct els_sts_entry_24xx*)pkt)->error_subcode_2);

1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617
	if (iocb_type == ELS_IOCB_TYPE) {
		els = &sp->u.iocb_cmd;
		els->u.els_plogi.fw_status[0] = fw_status[0];
		els->u.els_plogi.fw_status[1] = fw_status[1];
		els->u.els_plogi.fw_status[2] = fw_status[2];
		els->u.els_plogi.comp_status = fw_status[0];
		if (comp_status == CS_COMPLETE) {
			res =  DID_OK << 16;
		} else {
			if (comp_status == CS_DATA_UNDERRUN) {
				res =  DID_OK << 16;
				els->u.els_plogi.len =
				le16_to_cpu(((struct els_sts_entry_24xx *)
					pkt)->total_byte_count);
			} else {
				els->u.els_plogi.len = 0;
				res = DID_ERROR << 16;
			}
		}
		ql_log(ql_log_info, vha, 0x503f,
		    "ELS IOCB Done -%s error hdl=%x comp_status=0x%x error subcode 1=0x%x error subcode 2=0x%x total_byte=0x%x\n",
		    type, sp->handle, comp_status, fw_status[1], fw_status[2],
		    le16_to_cpu(((struct els_sts_entry_24xx *)
			pkt)->total_byte_count));
		goto els_ct_done;
	}

1618 1619 1620
	/* return FC_CTELS_STATUS_OK and leave the decoding of the ELS/CT
	 * fc payload  to the caller
	 */
1621 1622
	bsg_job = sp->u.bsg_job;
	bsg_reply = bsg_job->reply;
1623
	bsg_reply->reply_data.ctels_reply.status = FC_CTELS_STATUS_OK;
1624 1625 1626 1627
	bsg_job->reply_len = sizeof(struct fc_bsg_reply) + sizeof(fw_status);

	if (comp_status != CS_COMPLETE) {
		if (comp_status == CS_DATA_UNDERRUN) {
1628
			res = DID_OK << 16;
1629
			bsg_reply->reply_payload_rcv_len =
1630
			    le16_to_cpu(((struct els_sts_entry_24xx *)pkt)->total_byte_count);
1631

1632
			ql_dbg(ql_dbg_user, vha, 0x503f,
1633
			    "ELS-CT pass-through-%s error hdl=%x comp_status-status=0x%x "
1634
			    "error subcode 1=0x%x error subcode 2=0x%x total_byte = 0x%x.\n",
1635
			    type, sp->handle, comp_status, fw_status[1], fw_status[2],
1636 1637
			    le16_to_cpu(((struct els_sts_entry_24xx *)
				pkt)->total_byte_count));
1638
		} else {
1639
			ql_dbg(ql_dbg_user, vha, 0x5040,
1640
			    "ELS-CT pass-through-%s error hdl=%x comp_status-status=0x%x "
1641
			    "error subcode 1=0x%x error subcode 2=0x%x.\n",
1642
			    type, sp->handle, comp_status,
1643 1644 1645 1646
			    le16_to_cpu(((struct els_sts_entry_24xx *)
				pkt)->error_subcode_1),
			    le16_to_cpu(((struct els_sts_entry_24xx *)
				    pkt)->error_subcode_2));
1647
			res = DID_ERROR << 16;
1648
			bsg_reply->reply_payload_rcv_len = 0;
1649
		}
1650 1651
		memcpy(bsg_job->reply + sizeof(struct fc_bsg_reply),
		       fw_status, sizeof(fw_status));
1652
		ql_dump_buffer(ql_dbg_user + ql_dbg_buffer, vha, 0x5056,
1653
				(uint8_t *)pkt, sizeof(*pkt));
1654 1655
	}
	else {
1656
		res =  DID_OK << 16;
1657
		bsg_reply->reply_payload_rcv_len = bsg_job->reply_payload.payload_len;
1658 1659
		bsg_job->reply_len = 0;
	}
1660
els_ct_done:
1661

1662
	sp->done(sp, res);
1663 1664
}

1665 1666 1667 1668 1669 1670 1671 1672
static void
qla24xx_logio_entry(scsi_qla_host_t *vha, struct req_que *req,
    struct logio_entry_24xx *logio)
{
	const char func[] = "LOGIO-IOCB";
	const char *type;
	fc_port_t *fcport;
	srb_t *sp;
1673
	struct srb_iocb *lio;
1674
	uint16_t *data;
1675 1676 1677 1678 1679 1680
	uint32_t iop[2];

	sp = qla2x00_get_sp_from_handle(vha, func, req, logio);
	if (!sp)
		return;

1681 1682
	lio = &sp->u.iocb_cmd;
	type = sp->name;
1683
	fcport = sp->fcport;
1684
	data = lio->u.logio.data;
1685

1686
	data[0] = MBS_COMMAND_ERROR;
1687
	data[1] = lio->u.logio.flags & SRB_LOGIN_RETRIED ?
1688
		QLA_LOGIO_LOGIN_RETRIED : 0;
1689
	if (logio->entry_status) {
1690
		ql_log(ql_log_warn, fcport->vha, 0x5034,
1691
		    "Async-%s error entry - %8phC hdl=%x"
1692
		    "portid=%02x%02x%02x entry-status=%x.\n",
1693
		    type, fcport->port_name, sp->handle, fcport->d_id.b.domain,
1694 1695 1696
		    fcport->d_id.b.area, fcport->d_id.b.al_pa,
		    logio->entry_status);
		ql_dump_buffer(ql_dbg_async + ql_dbg_buffer, vha, 0x504d,
1697
		    (uint8_t *)logio, sizeof(*logio));
1698

1699
		goto logio_done;
1700 1701 1702
	}

	if (le16_to_cpu(logio->comp_status) == CS_COMPLETE) {
1703
		ql_dbg(ql_dbg_async, fcport->vha, 0x5036,
1704 1705 1706
		    "Async-%s complete - %8phC hdl=%x portid=%02x%02x%02x "
		    "iop0=%x.\n", type, fcport->port_name, sp->handle,
		    fcport->d_id.b.domain,
1707
		    fcport->d_id.b.area, fcport->d_id.b.al_pa,
1708
		    le32_to_cpu(logio->io_parameter[0]));
1709

1710
		vha->hw->exch_starvation = 0;
1711
		data[0] = MBS_COMMAND_COMPLETE;
1712
		if (sp->type != SRB_LOGIN_CMD)
1713
			goto logio_done;
1714 1715 1716 1717 1718

		iop[0] = le32_to_cpu(logio->io_parameter[0]);
		if (iop[0] & BIT_4) {
			fcport->port_type = FCT_TARGET;
			if (iop[0] & BIT_8)
1719
				fcport->flags |= FCF_FCP2_DEVICE;
1720
		} else if (iop[0] & BIT_5)
1721
			fcport->port_type = FCT_INITIATOR;
1722

1723 1724 1725
		if (iop[0] & BIT_7)
			fcport->flags |= FCF_CONF_COMP_SUPPORTED;

1726 1727 1728 1729 1730
		if (logio->io_parameter[7] || logio->io_parameter[8])
			fcport->supported_classes |= FC_COS_CLASS2;
		if (logio->io_parameter[9] || logio->io_parameter[10])
			fcport->supported_classes |= FC_COS_CLASS3;

1731
		goto logio_done;
1732 1733 1734 1735
	}

	iop[0] = le32_to_cpu(logio->io_parameter[0]);
	iop[1] = le32_to_cpu(logio->io_parameter[1]);
1736 1737
	lio->u.logio.iop[0] = iop[0];
	lio->u.logio.iop[1] = iop[1];
1738 1739 1740 1741 1742 1743 1744 1745
	switch (iop[0]) {
	case LSC_SCODE_PORTID_USED:
		data[0] = MBS_PORT_ID_USED;
		data[1] = LSW(iop[1]);
		break;
	case LSC_SCODE_NPORT_USED:
		data[0] = MBS_LOOP_ID_USED;
		break;
1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756
	case LSC_SCODE_CMD_FAILED:
		if (iop[1] == 0x0606) {
			/*
			 * PLOGI/PRLI Completed. We must have Recv PLOGI/PRLI,
			 * Target side acked.
			 */
			data[0] = MBS_COMMAND_COMPLETE;
			goto logio_done;
		}
		data[0] = MBS_COMMAND_ERROR;
		break;
1757 1758 1759
	case LSC_SCODE_NOXCB:
		vha->hw->exch_starvation++;
		if (vha->hw->exch_starvation > 5) {
1760
			ql_log(ql_log_warn, vha, 0xd046,
1761 1762 1763 1764 1765 1766 1767 1768 1769 1770
			    "Exchange starvation. Resetting RISC\n");

			vha->hw->exch_starvation = 0;

			if (IS_P3P_TYPE(vha->hw))
				set_bit(FCOE_CTX_RESET_NEEDED, &vha->dpc_flags);
			else
				set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
			qla2xxx_wake_dpc(vha);
		}
1771
		/* fall through */
1772 1773 1774 1775 1776
	default:
		data[0] = MBS_COMMAND_ERROR;
		break;
	}

1777
	ql_dbg(ql_dbg_async, fcport->vha, 0x5037,
1778 1779 1780
	    "Async-%s failed - %8phC hdl=%x portid=%02x%02x%02x comp=%x "
	    "iop0=%x iop1=%x.\n", type, fcport->port_name,
		sp->handle, fcport->d_id.b.domain,
1781
	    fcport->d_id.b.area, fcport->d_id.b.al_pa,
1782 1783
	    le16_to_cpu(logio->comp_status),
	    le32_to_cpu(logio->io_parameter[0]),
1784
	    le32_to_cpu(logio->io_parameter[1]));
1785

1786
logio_done:
1787
	sp->done(sp, 0);
1788 1789
}

1790
static void
1791
qla24xx_tm_iocb_entry(scsi_qla_host_t *vha, struct req_que *req, void *tsk)
1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803
{
	const char func[] = "TMF-IOCB";
	const char *type;
	fc_port_t *fcport;
	srb_t *sp;
	struct srb_iocb *iocb;
	struct sts_entry_24xx *sts = (struct sts_entry_24xx *)tsk;

	sp = qla2x00_get_sp_from_handle(vha, func, req, tsk);
	if (!sp)
		return;

1804 1805
	iocb = &sp->u.iocb_cmd;
	type = sp->name;
1806
	fcport = sp->fcport;
1807
	iocb->u.tmf.data = QLA_SUCCESS;
1808 1809

	if (sts->entry_status) {
1810
		ql_log(ql_log_warn, fcport->vha, 0x5038,
1811 1812
		    "Async-%s error - hdl=%x entry-status(%x).\n",
		    type, sp->handle, sts->entry_status);
1813
		iocb->u.tmf.data = QLA_FUNCTION_FAILED;
1814
	} else if (sts->comp_status != cpu_to_le16(CS_COMPLETE)) {
1815
		ql_log(ql_log_warn, fcport->vha, 0x5039,
1816 1817
		    "Async-%s error - hdl=%x completion status(%x).\n",
		    type, sp->handle, sts->comp_status);
1818 1819
		iocb->u.tmf.data = QLA_FUNCTION_FAILED;
	} else if ((le16_to_cpu(sts->scsi_status) &
1820
	    SS_RESPONSE_INFO_LEN_VALID)) {
1821 1822 1823 1824 1825 1826 1827 1828
		if (le32_to_cpu(sts->rsp_data_len) < 4) {
			ql_log(ql_log_warn, fcport->vha, 0x503b,
			    "Async-%s error - hdl=%x not enough response(%d).\n",
			    type, sp->handle, sts->rsp_data_len);
		} else if (sts->data[3]) {
			ql_log(ql_log_warn, fcport->vha, 0x503c,
			    "Async-%s error - hdl=%x response(%x).\n",
			    type, sp->handle, sts->data[3]);
B
Bart Van Assche 已提交
1829
			iocb->u.tmf.data = QLA_FUNCTION_FAILED;
1830
		}
1831 1832
	}

1833
	if (iocb->u.tmf.data != QLA_SUCCESS)
1834 1835
		ql_dump_buffer(ql_dbg_async + ql_dbg_buffer, vha, 0x5055,
		    (uint8_t *)sts, sizeof(*sts));
1836

1837
	sp->done(sp, 0);
1838 1839
}

1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864
static void
qla24xx_nvme_iocb_entry(scsi_qla_host_t *vha, struct req_que *req, void *tsk)
{
	const char func[] = "NVME-IOCB";
	fc_port_t *fcport;
	srb_t *sp;
	struct srb_iocb *iocb;
	struct sts_entry_24xx *sts = (struct sts_entry_24xx *)tsk;
	uint16_t        state_flags;
	struct nvmefc_fcp_req *fd;
	uint16_t        ret = 0;
	struct srb_iocb *nvme;

	sp = qla2x00_get_sp_from_handle(vha, func, req, tsk);
	if (!sp)
		return;

	iocb = &sp->u.iocb_cmd;
	fcport = sp->fcport;
	iocb->u.nvme.comp_status = le16_to_cpu(sts->comp_status);
	state_flags  = le16_to_cpu(sts->state_flags);
	fd = iocb->u.nvme.desc;
	nvme = &sp->u.iocb_cmd;

	if (unlikely(nvme->u.nvme.aen_op))
1865
		atomic_dec(&sp->vha->hw->nvme_active_aen_cnt);
1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897

	/*
	 * State flags: Bit 6 and 0.
	 * If 0 is set, we don't care about 6.
	 * both cases resp was dma'd to host buffer
	 * if both are 0, that is good path case.
	 * if six is set and 0 is clear, we need to
	 * copy resp data from status iocb to resp buffer.
	 */
	if (!(state_flags & (SF_FCP_RSP_DMA | SF_NVME_ERSP))) {
		iocb->u.nvme.rsp_pyld_len = 0;
	} else if ((state_flags & SF_FCP_RSP_DMA)) {
		iocb->u.nvme.rsp_pyld_len = le16_to_cpu(sts->nvme_rsp_pyld_len);
	} else if (state_flags & SF_NVME_ERSP) {
		uint32_t *inbuf, *outbuf;
		uint16_t iter;

		inbuf = (uint32_t *)&sts->nvme_ersp_data;
		outbuf = (uint32_t *)fd->rspaddr;
		iocb->u.nvme.rsp_pyld_len = le16_to_cpu(sts->nvme_rsp_pyld_len);
		iter = iocb->u.nvme.rsp_pyld_len >> 2;
		for (; iter; iter--)
			*outbuf++ = swab32(*inbuf++);
	} else { /* unhandled case */
	    ql_log(ql_log_warn, fcport->vha, 0x503a,
		"NVME-%s error. Unhandled state_flags of %x\n",
		sp->name, state_flags);
	}

	fd->transferred_length = fd->payload_length -
	    le32_to_cpu(sts->residual_len);

1898 1899 1900 1901
	/*
	 * If transport error then Failure (HBA rejects request)
	 * otherwise transport will handle.
	 */
1902 1903 1904 1905 1906
	if (sts->entry_status) {
		ql_log(ql_log_warn, fcport->vha, 0x5038,
		    "NVME-%s error - hdl=%x entry-status(%x).\n",
		    sp->name, sp->handle, sts->entry_status);
		ret = QLA_FUNCTION_FAILED;
1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933
	} else  {
		switch (le16_to_cpu(sts->comp_status)) {
			case CS_COMPLETE:
				ret = 0;
			break;

			case CS_ABORTED:
			case CS_RESET:
			case CS_PORT_UNAVAILABLE:
			case CS_PORT_LOGGED_OUT:
			case CS_PORT_BUSY:
				ql_log(ql_log_warn, fcport->vha, 0x5060,
				"NVME-%s ERR Handling - hdl=%x completion status(%x) resid=%x  ox_id=%x\n",
				sp->name, sp->handle, sts->comp_status,
				le32_to_cpu(sts->residual_len), sts->ox_id);
				fd->transferred_length = fd->payload_length;
				ret = QLA_ABORTED;
			break;

			default:
				ql_log(ql_log_warn, fcport->vha, 0x5060,
				"NVME-%s error - hdl=%x completion status(%x) resid=%x  ox_id=%x\n",
				sp->name, sp->handle, sts->comp_status,
				le32_to_cpu(sts->residual_len), sts->ox_id);
				ret = QLA_FUNCTION_FAILED;
				break;
		}
1934 1935 1936 1937
	}
	sp->done(sp, ret);
}

1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968
static void qla_ctrlvp_completed(scsi_qla_host_t *vha, struct req_que *req,
    struct vp_ctrl_entry_24xx *vce)
{
	const char func[] = "CTRLVP-IOCB";
	srb_t *sp;
	int rval = QLA_SUCCESS;

	sp = qla2x00_get_sp_from_handle(vha, func, req, vce);
	if (!sp)
		return;

	if (vce->entry_status != 0) {
		ql_dbg(ql_dbg_vport, vha, 0x10c4,
		    "%s: Failed to complete IOCB -- error status (%x)\n",
		    sp->name, vce->entry_status);
		rval = QLA_FUNCTION_FAILED;
	} else if (vce->comp_status != cpu_to_le16(CS_COMPLETE)) {
		ql_dbg(ql_dbg_vport, vha, 0x10c5,
		    "%s: Failed to complete IOCB -- completion status (%x) vpidx %x\n",
		    sp->name, le16_to_cpu(vce->comp_status),
		    le16_to_cpu(vce->vp_idx_failed));
		rval = QLA_FUNCTION_FAILED;
	} else {
		ql_dbg(ql_dbg_vport, vha, 0x10c6,
		    "Done %s.\n", __func__);
	}

	sp->rc = rval;
	sp->done(sp, rval);
}

L
Linus Torvalds 已提交
1969 1970 1971 1972 1973
/**
 * qla2x00_process_response_queue() - Process response queue entries.
 * @ha: SCSI driver HA context
 */
void
1974
qla2x00_process_response_queue(struct rsp_que *rsp)
L
Linus Torvalds 已提交
1975
{
1976 1977
	struct scsi_qla_host *vha;
	struct qla_hw_data *ha = rsp->hw;
1978
	struct device_reg_2xxx __iomem *reg = &ha->iobase->isp;
L
Linus Torvalds 已提交
1979 1980 1981
	sts_entry_t	*pkt;
	uint16_t        handle_cnt;
	uint16_t        cnt;
1982

1983
	vha = pci_get_drvdata(ha->pdev);
L
Linus Torvalds 已提交
1984

1985
	if (!vha->flags.online)
L
Linus Torvalds 已提交
1986 1987
		return;

1988 1989
	while (rsp->ring_ptr->signature != RESPONSE_PROCESSED) {
		pkt = (sts_entry_t *)rsp->ring_ptr;
L
Linus Torvalds 已提交
1990

1991 1992 1993 1994
		rsp->ring_index++;
		if (rsp->ring_index == rsp->length) {
			rsp->ring_index = 0;
			rsp->ring_ptr = rsp->ring;
L
Linus Torvalds 已提交
1995
		} else {
1996
			rsp->ring_ptr++;
L
Linus Torvalds 已提交
1997 1998 1999
		}

		if (pkt->entry_status != 0) {
2000
			qla2x00_error_entry(vha, rsp, pkt);
L
Linus Torvalds 已提交
2001 2002 2003 2004 2005 2006 2007
			((response_t *)pkt)->signature = RESPONSE_PROCESSED;
			wmb();
			continue;
		}

		switch (pkt->entry_type) {
		case STATUS_TYPE:
2008
			qla2x00_status_entry(vha, rsp, pkt);
L
Linus Torvalds 已提交
2009 2010 2011 2012
			break;
		case STATUS_TYPE_21:
			handle_cnt = ((sts21_entry_t *)pkt)->handle_count;
			for (cnt = 0; cnt < handle_cnt; cnt++) {
2013
				qla2x00_process_completed_request(vha, rsp->req,
L
Linus Torvalds 已提交
2014 2015 2016 2017 2018 2019
				    ((sts21_entry_t *)pkt)->handle[cnt]);
			}
			break;
		case STATUS_TYPE_22:
			handle_cnt = ((sts22_entry_t *)pkt)->handle_count;
			for (cnt = 0; cnt < handle_cnt; cnt++) {
2020
				qla2x00_process_completed_request(vha, rsp->req,
L
Linus Torvalds 已提交
2021 2022 2023 2024
				    ((sts22_entry_t *)pkt)->handle[cnt]);
			}
			break;
		case STATUS_CONT_TYPE:
2025
			qla2x00_status_cont_entry(rsp, (sts_cont_entry_t *)pkt);
L
Linus Torvalds 已提交
2026
			break;
2027 2028 2029
		case MBX_IOCB_TYPE:
			qla2x00_mbx_iocb_entry(vha, rsp->req,
			    (struct mbx_entry *)pkt);
2030
			break;
2031 2032 2033
		case CT_IOCB_TYPE:
			qla2x00_ct_entry(vha, rsp->req, pkt, CT_IOCB_TYPE);
			break;
L
Linus Torvalds 已提交
2034 2035
		default:
			/* Type Not Supported. */
2036 2037
			ql_log(ql_log_warn, vha, 0x504a,
			    "Received unknown response pkt type %x "
L
Linus Torvalds 已提交
2038
			    "entry status=%x.\n",
2039
			    pkt->entry_type, pkt->entry_status);
L
Linus Torvalds 已提交
2040 2041 2042 2043 2044 2045 2046
			break;
		}
		((response_t *)pkt)->signature = RESPONSE_PROCESSED;
		wmb();
	}

	/* Adjust ring index */
2047
	WRT_REG_WORD(ISP_RSP_Q_OUT(ha, reg), rsp->ring_index);
L
Linus Torvalds 已提交
2048 2049
}

2050
static inline void
2051
qla2x00_handle_sense(srb_t *sp, uint8_t *sense_data, uint32_t par_sense_len,
2052
		     uint32_t sense_len, struct rsp_que *rsp, int res)
2053
{
2054
	struct scsi_qla_host *vha = sp->vha;
2055 2056
	struct scsi_cmnd *cp = GET_CMD_SP(sp);
	uint32_t track_sense_len;
2057 2058 2059 2060

	if (sense_len >= SCSI_SENSE_BUFFERSIZE)
		sense_len = SCSI_SENSE_BUFFERSIZE;

2061 2062 2063 2064 2065
	SET_CMD_SENSE_LEN(sp, sense_len);
	SET_CMD_SENSE_PTR(sp, cp->sense_buffer);
	track_sense_len = sense_len;

	if (sense_len > par_sense_len)
2066
		sense_len = par_sense_len;
2067 2068 2069

	memcpy(cp->sense_buffer, sense_data, sense_len);

2070 2071 2072 2073 2074
	SET_CMD_SENSE_PTR(sp, cp->sense_buffer + sense_len);
	track_sense_len -= sense_len;
	SET_CMD_SENSE_LEN(sp, track_sense_len);

	if (track_sense_len != 0) {
2075
		rsp->status_srb = sp;
2076 2077
		cp->result = res;
	}
2078

2079 2080
	if (sense_len) {
		ql_dbg(ql_dbg_io + ql_dbg_buffer, vha, 0x301c,
H
Hannes Reinecke 已提交
2081
		    "Check condition Sense data, nexus%ld:%d:%llu cmd=%p.\n",
2082
		    sp->vha->host_no, cp->device->id, cp->device->lun,
2083
		    cp);
2084 2085
		ql_dump_buffer(ql_dbg_io + ql_dbg_buffer, vha, 0x302b,
		    cp->sense_buffer, sense_len);
2086
	}
2087 2088
}

2089 2090
struct scsi_dif_tuple {
	__be16 guard;       /* Checksum */
2091
	__be16 app_tag;         /* APPL identifier */
2092 2093 2094 2095 2096 2097 2098 2099 2100
	__be32 ref_tag;         /* Target LBA or indirect LBA */
};

/*
 * Checks the guard or meta-data for the type of error
 * detected by the HBA. In case of errors, we set the
 * ASC/ASCQ fields in the sense buffer with ILLEGAL_REQUEST
 * to indicate to the kernel that the HBA detected error.
 */
2101
static inline int
2102 2103
qla2x00_handle_dif_error(srb_t *sp, struct sts_entry_24xx *sts24)
{
2104
	struct scsi_qla_host *vha = sp->vha;
2105
	struct scsi_cmnd *cmd = GET_CMD_SP(sp);
2106 2107
	uint8_t		*ap = &sts24->data[12];
	uint8_t		*ep = &sts24->data[20];
2108 2109 2110 2111
	uint32_t	e_ref_tag, a_ref_tag;
	uint16_t	e_app_tag, a_app_tag;
	uint16_t	e_guard, a_guard;

2112 2113 2114 2115 2116 2117 2118 2119 2120 2121
	/*
	 * swab32 of the "data" field in the beginning of qla2x00_status_entry()
	 * would make guard field appear at offset 2
	 */
	a_guard   = le16_to_cpu(*(uint16_t *)(ap + 2));
	a_app_tag = le16_to_cpu(*(uint16_t *)(ap + 0));
	a_ref_tag = le32_to_cpu(*(uint32_t *)(ap + 4));
	e_guard   = le16_to_cpu(*(uint16_t *)(ep + 2));
	e_app_tag = le16_to_cpu(*(uint16_t *)(ep + 0));
	e_ref_tag = le32_to_cpu(*(uint32_t *)(ep + 4));
2122

2123 2124
	ql_dbg(ql_dbg_io, vha, 0x3023,
	    "iocb(s) %p Returned STATUS.\n", sts24);
2125

2126 2127
	ql_dbg(ql_dbg_io, vha, 0x3024,
	    "DIF ERROR in cmd 0x%x lba 0x%llx act ref"
2128
	    " tag=0x%x, exp ref_tag=0x%x, act app tag=0x%x, exp app"
2129
	    " tag=0x%x, act guard=0x%x, exp guard=0x%x.\n",
2130
	    cmd->cmnd[0], (u64)scsi_get_lba(cmd), a_ref_tag, e_ref_tag,
2131
	    a_app_tag, e_app_tag, a_guard, e_guard);
2132

2133 2134 2135 2136 2137
	/*
	 * Ignore sector if:
	 * For type     3: ref & app tag is all 'f's
	 * For type 0,1,2: app tag is all 'f's
	 */
2138
	if ((a_app_tag == T10_PI_APP_ESCAPE) &&
2139
	    ((scsi_get_prot_type(cmd) != SCSI_PROT_DIF_TYPE3) ||
2140
	     (a_ref_tag == T10_PI_REF_ESCAPE))) {
2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156
		uint32_t blocks_done, resid;
		sector_t lba_s = scsi_get_lba(cmd);

		/* 2TB boundary case covered automatically with this */
		blocks_done = e_ref_tag - (uint32_t)lba_s + 1;

		resid = scsi_bufflen(cmd) - (blocks_done *
		    cmd->device->sector_size);

		scsi_set_resid(cmd, resid);
		cmd->result = DID_OK << 16;

		/* Update protection tag */
		if (scsi_prot_sg_count(cmd)) {
			uint32_t i, j = 0, k = 0, num_ent;
			struct scatterlist *sg;
2157
			struct t10_pi_tuple *spt;
2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172

			/* Patch the corresponding protection tags */
			scsi_for_each_prot_sg(cmd, sg,
			    scsi_prot_sg_count(cmd), i) {
				num_ent = sg_dma_len(sg) / 8;
				if (k + num_ent < blocks_done) {
					k += num_ent;
					continue;
				}
				j = blocks_done - k - 1;
				k = blocks_done;
				break;
			}

			if (k != blocks_done) {
2173
				ql_log(ql_log_warn, vha, 0x302f,
2174 2175
				    "unexpected tag values tag:lba=%x:%llx)\n",
				    e_ref_tag, (unsigned long long)lba_s);
2176 2177 2178 2179 2180 2181
				return 1;
			}

			spt = page_address(sg_page(sg)) + sg->offset;
			spt += j;

2182
			spt->app_tag = T10_PI_APP_ESCAPE;
2183
			if (scsi_get_prot_type(cmd) == SCSI_PROT_DIF_TYPE3)
2184
				spt->ref_tag = T10_PI_REF_ESCAPE;
2185 2186 2187 2188 2189
		}

		return 0;
	}

2190 2191 2192 2193 2194 2195 2196
	/* check guard */
	if (e_guard != a_guard) {
		scsi_build_sense_buffer(1, cmd->sense_buffer, ILLEGAL_REQUEST,
		    0x10, 0x1);
		set_driver_byte(cmd, DRIVER_SENSE);
		set_host_byte(cmd, DID_ABORT);
		cmd->result |= SAM_STAT_CHECK_CONDITION << 1;
2197
		return 1;
2198 2199
	}

2200 2201
	/* check ref tag */
	if (e_ref_tag != a_ref_tag) {
2202
		scsi_build_sense_buffer(1, cmd->sense_buffer, ILLEGAL_REQUEST,
2203
		    0x10, 0x3);
2204 2205 2206
		set_driver_byte(cmd, DRIVER_SENSE);
		set_host_byte(cmd, DID_ABORT);
		cmd->result |= SAM_STAT_CHECK_CONDITION << 1;
2207
		return 1;
2208 2209
	}

2210 2211
	/* check appl tag */
	if (e_app_tag != a_app_tag) {
2212
		scsi_build_sense_buffer(1, cmd->sense_buffer, ILLEGAL_REQUEST,
2213
		    0x10, 0x2);
2214 2215 2216
		set_driver_byte(cmd, DRIVER_SENSE);
		set_host_byte(cmd, DID_ABORT);
		cmd->result |= SAM_STAT_CHECK_CONDITION << 1;
2217
		return 1;
2218
	}
2219

2220
	return 1;
2221 2222
}

2223 2224 2225 2226 2227 2228 2229 2230 2231 2232
static void
qla25xx_process_bidir_status_iocb(scsi_qla_host_t *vha, void *pkt,
				  struct req_que *req, uint32_t index)
{
	struct qla_hw_data *ha = vha->hw;
	srb_t *sp;
	uint16_t	comp_status;
	uint16_t	scsi_status;
	uint16_t thread_id;
	uint32_t rval = EXT_STATUS_OK;
2233
	struct bsg_job *bsg_job = NULL;
2234 2235
	struct fc_bsg_request *bsg_request;
	struct fc_bsg_reply *bsg_reply;
2236 2237 2238 2239 2240 2241
	sts_entry_t *sts;
	struct sts_entry_24xx *sts24;
	sts = (sts_entry_t *) pkt;
	sts24 = (struct sts_entry_24xx *) pkt;

	/* Validate handle. */
2242
	if (index >= req->num_outstanding_cmds) {
2243 2244 2245 2246 2247 2248 2249
		ql_log(ql_log_warn, vha, 0x70af,
		    "Invalid SCSI completion handle 0x%x.\n", index);
		set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
		return;
	}

	sp = req->outstanding_cmds[index];
2250
	if (!sp) {
2251 2252 2253 2254 2255 2256 2257 2258
		ql_log(ql_log_warn, vha, 0x70b0,
		    "Req:%d: Invalid ISP SCSI completion handle(0x%x)\n",
		    req->id, index);

		set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
		return;
	}

2259 2260 2261 2262 2263 2264
	/* Free outstanding command slot. */
	req->outstanding_cmds[index] = NULL;
	bsg_job = sp->u.bsg_job;
	bsg_request = bsg_job->request;
	bsg_reply = bsg_job->reply;

2265 2266 2267 2268 2269 2270 2271 2272
	if (IS_FWI2_CAPABLE(ha)) {
		comp_status = le16_to_cpu(sts24->comp_status);
		scsi_status = le16_to_cpu(sts24->scsi_status) & SS_MASK;
	} else {
		comp_status = le16_to_cpu(sts->comp_status);
		scsi_status = le16_to_cpu(sts->scsi_status) & SS_MASK;
	}

2273
	thread_id = bsg_request->rqst_data.h_vendor.vendor_cmd[1];
2274 2275 2276
	switch (comp_status) {
	case CS_COMPLETE:
		if (scsi_status == 0) {
2277
			bsg_reply->reply_payload_rcv_len =
2278
					bsg_job->reply_payload.payload_len;
2279
			vha->qla_stats.input_bytes +=
2280
				bsg_reply->reply_payload_rcv_len;
2281
			vha->qla_stats.input_requests++;
2282 2283 2284 2285 2286 2287
			rval = EXT_STATUS_OK;
		}
		goto done;

	case CS_DATA_OVERRUN:
		ql_dbg(ql_dbg_user, vha, 0x70b1,
2288
		    "Command completed with data overrun thread_id=%d\n",
2289 2290 2291 2292 2293 2294
		    thread_id);
		rval = EXT_STATUS_DATA_OVERRUN;
		break;

	case CS_DATA_UNDERRUN:
		ql_dbg(ql_dbg_user, vha, 0x70b2,
2295
		    "Command completed with data underrun thread_id=%d\n",
2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321
		    thread_id);
		rval = EXT_STATUS_DATA_UNDERRUN;
		break;
	case CS_BIDIR_RD_OVERRUN:
		ql_dbg(ql_dbg_user, vha, 0x70b3,
		    "Command completed with read data overrun thread_id=%d\n",
		    thread_id);
		rval = EXT_STATUS_DATA_OVERRUN;
		break;

	case CS_BIDIR_RD_WR_OVERRUN:
		ql_dbg(ql_dbg_user, vha, 0x70b4,
		    "Command completed with read and write data overrun "
		    "thread_id=%d\n", thread_id);
		rval = EXT_STATUS_DATA_OVERRUN;
		break;

	case CS_BIDIR_RD_OVERRUN_WR_UNDERRUN:
		ql_dbg(ql_dbg_user, vha, 0x70b5,
		    "Command completed with read data over and write data "
		    "underrun thread_id=%d\n", thread_id);
		rval = EXT_STATUS_DATA_OVERRUN;
		break;

	case CS_BIDIR_RD_UNDERRUN:
		ql_dbg(ql_dbg_user, vha, 0x70b6,
2322
		    "Command completed with read data underrun "
2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359 2360
		    "thread_id=%d\n", thread_id);
		rval = EXT_STATUS_DATA_UNDERRUN;
		break;

	case CS_BIDIR_RD_UNDERRUN_WR_OVERRUN:
		ql_dbg(ql_dbg_user, vha, 0x70b7,
		    "Command completed with read data under and write data "
		    "overrun thread_id=%d\n", thread_id);
		rval = EXT_STATUS_DATA_UNDERRUN;
		break;

	case CS_BIDIR_RD_WR_UNDERRUN:
		ql_dbg(ql_dbg_user, vha, 0x70b8,
		    "Command completed with read and write data underrun "
		    "thread_id=%d\n", thread_id);
		rval = EXT_STATUS_DATA_UNDERRUN;
		break;

	case CS_BIDIR_DMA:
		ql_dbg(ql_dbg_user, vha, 0x70b9,
		    "Command completed with data DMA error thread_id=%d\n",
		    thread_id);
		rval = EXT_STATUS_DMA_ERR;
		break;

	case CS_TIMEOUT:
		ql_dbg(ql_dbg_user, vha, 0x70ba,
		    "Command completed with timeout thread_id=%d\n",
		    thread_id);
		rval = EXT_STATUS_TIMEOUT;
		break;
	default:
		ql_dbg(ql_dbg_user, vha, 0x70bb,
		    "Command completed with completion status=0x%x "
		    "thread_id=%d\n", comp_status, thread_id);
		rval = EXT_STATUS_ERR;
		break;
	}
2361
	bsg_reply->reply_payload_rcv_len = 0;
2362 2363 2364

done:
	/* Return the vendor specific reply to API */
2365
	bsg_reply->reply_data.vendor_reply.vendor_rsp[0] = rval;
2366 2367 2368
	bsg_job->reply_len = sizeof(struct fc_bsg_reply);
	/* Always return DID_OK, bsg will send the vendor specific response
	 * in this case only */
2369
	sp->done(sp, DID_OK << 6);
2370 2371 2372

}

L
Linus Torvalds 已提交
2373 2374 2375 2376 2377 2378
/**
 * qla2x00_status_entry() - Process a Status IOCB entry.
 * @ha: SCSI driver HA context
 * @pkt: Entry pointer
 */
static void
2379
qla2x00_status_entry(scsi_qla_host_t *vha, struct rsp_que *rsp, void *pkt)
L
Linus Torvalds 已提交
2380 2381 2382 2383
{
	srb_t		*sp;
	fc_port_t	*fcport;
	struct scsi_cmnd *cp;
2384 2385
	sts_entry_t *sts;
	struct sts_entry_24xx *sts24;
L
Linus Torvalds 已提交
2386 2387
	uint16_t	comp_status;
	uint16_t	scsi_status;
2388
	uint16_t	ox_id;
L
Linus Torvalds 已提交
2389 2390
	uint8_t		lscsi_status;
	int32_t		resid;
2391 2392
	uint32_t sense_len, par_sense_len, rsp_info_len, resid_len,
	    fw_resid_len;
2393
	uint8_t		*rsp_info, *sense_data;
2394
	struct qla_hw_data *ha = vha->hw;
2395 2396 2397
	uint32_t handle;
	uint16_t que;
	struct req_que *req;
2398
	int logit = 1;
2399
	int res = 0;
2400
	uint16_t state_flags = 0;
2401
	uint16_t retry_delay = 0;
2402 2403 2404

	sts = (sts_entry_t *) pkt;
	sts24 = (struct sts_entry_24xx *) pkt;
2405
	if (IS_FWI2_CAPABLE(ha)) {
2406 2407
		comp_status = le16_to_cpu(sts24->comp_status);
		scsi_status = le16_to_cpu(sts24->scsi_status) & SS_MASK;
2408
		state_flags = le16_to_cpu(sts24->state_flags);
2409 2410 2411 2412
	} else {
		comp_status = le16_to_cpu(sts->comp_status);
		scsi_status = le16_to_cpu(sts->scsi_status) & SS_MASK;
	}
2413 2414 2415
	handle = (uint32_t) LSW(sts->handle);
	que = MSW(sts->handle);
	req = ha->req_q_map[que];
2416

2417 2418 2419 2420 2421 2422 2423 2424 2425
	/* Check for invalid queue pointer */
	if (req == NULL ||
	    que >= find_first_zero_bit(ha->req_qid_map, ha->max_req_queues)) {
		ql_dbg(ql_dbg_io, vha, 0x3059,
		    "Invalid status handle (0x%x): Bad req pointer. req=%p, "
		    "que=%u.\n", sts->handle, req, que);
		return;
	}

L
Linus Torvalds 已提交
2426
	/* Validate handle. */
2427
	if (handle < req->num_outstanding_cmds) {
2428
		sp = req->outstanding_cmds[handle];
2429 2430 2431 2432 2433 2434 2435
		if (!sp) {
			ql_dbg(ql_dbg_io, vha, 0x3075,
			    "%s(%ld): Already returned command for status handle (0x%x).\n",
			    __func__, vha->host_no, sts->handle);
			return;
		}
	} else {
2436
		ql_dbg(ql_dbg_io, vha, 0x3017,
2437 2438
		    "Invalid status handle, out of range (0x%x).\n",
		    sts->handle);
L
Linus Torvalds 已提交
2439

2440 2441 2442 2443 2444 2445 2446
		if (!test_bit(ABORT_ISP_ACTIVE, &vha->dpc_flags)) {
			if (IS_P3P_TYPE(ha))
				set_bit(FCOE_CTX_RESET_NEEDED, &vha->dpc_flags);
			else
				set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
			qla2xxx_wake_dpc(vha);
		}
L
Linus Torvalds 已提交
2447 2448
		return;
	}
2449

2450 2451 2452 2453 2454 2455 2456 2457
	if (sp->cmd_type != TYPE_SRB) {
		req->outstanding_cmds[handle] = NULL;
		ql_dbg(ql_dbg_io, vha, 0x3015,
		    "Unknown sp->cmd_type %x %p).\n",
		    sp->cmd_type, sp);
		return;
	}

2458 2459 2460 2461 2462 2463
	/* NVME completion. */
	if (sp->type == SRB_NVME_CMD) {
		qla24xx_nvme_iocb_entry(vha, req, pkt);
		return;
	}

2464 2465 2466 2467 2468
	if (unlikely((state_flags & BIT_1) && (sp->type == SRB_BIDI_CMD))) {
		qla25xx_process_bidir_status_iocb(vha, pkt, req, handle);
		return;
	}

2469 2470 2471 2472 2473 2474
	/* Task Management completion. */
	if (sp->type == SRB_TM_CMD) {
		qla24xx_tm_iocb_entry(vha, req, pkt);
		return;
	}

2475 2476 2477 2478 2479 2480 2481 2482
	/* Fast path completion. */
	if (comp_status == CS_COMPLETE && scsi_status == 0) {
		qla2x00_process_completed_request(vha, req, handle);

		return;
	}

	req->outstanding_cmds[handle] = NULL;
2483
	cp = GET_CMD_SP(sp);
L
Linus Torvalds 已提交
2484
	if (cp == NULL) {
2485
		ql_dbg(ql_dbg_io, vha, 0x3018,
2486 2487
		    "Command already returned (0x%x/%p).\n",
		    sts->handle, sp);
L
Linus Torvalds 已提交
2488 2489 2490 2491

		return;
	}

2492
	lscsi_status = scsi_status & STATUS_MASK;
L
Linus Torvalds 已提交
2493

2494
	fcport = sp->fcport;
L
Linus Torvalds 已提交
2495

2496
	ox_id = 0;
2497 2498
	sense_len = par_sense_len = rsp_info_len = resid_len =
	    fw_resid_len = 0;
2499
	if (IS_FWI2_CAPABLE(ha)) {
2500 2501 2502 2503 2504 2505 2506 2507
		if (scsi_status & SS_SENSE_LEN_VALID)
			sense_len = le32_to_cpu(sts24->sense_len);
		if (scsi_status & SS_RESPONSE_INFO_LEN_VALID)
			rsp_info_len = le32_to_cpu(sts24->rsp_data_len);
		if (scsi_status & (SS_RESIDUAL_UNDER | SS_RESIDUAL_OVER))
			resid_len = le32_to_cpu(sts24->rsp_residual_count);
		if (comp_status == CS_DATA_UNDERRUN)
			fw_resid_len = le32_to_cpu(sts24->residual_len);
2508 2509 2510
		rsp_info = sts24->data;
		sense_data = sts24->data;
		host_to_fcp_swap(sts24->data, sizeof(sts24->data));
2511
		ox_id = le16_to_cpu(sts24->ox_id);
2512
		par_sense_len = sizeof(sts24->data);
2513 2514 2515
		/* Valid values of the retry delay timer are 0x1-0xffef */
		if (sts24->retry_delay > 0 && sts24->retry_delay < 0xfff1)
			retry_delay = sts24->retry_delay;
2516
	} else {
2517 2518 2519 2520
		if (scsi_status & SS_SENSE_LEN_VALID)
			sense_len = le16_to_cpu(sts->req_sense_length);
		if (scsi_status & SS_RESPONSE_INFO_LEN_VALID)
			rsp_info_len = le16_to_cpu(sts->rsp_info_len);
2521 2522 2523
		resid_len = le32_to_cpu(sts->residual_length);
		rsp_info = sts->rsp_info;
		sense_data = sts->req_sense_data;
2524
		par_sense_len = sizeof(sts->req_sense_data);
2525 2526
	}

L
Linus Torvalds 已提交
2527 2528
	/* Check for any FCP transport errors. */
	if (scsi_status & SS_RESPONSE_INFO_LEN_VALID) {
2529
		/* Sense data lies beyond any FCP RESPONSE data. */
2530
		if (IS_FWI2_CAPABLE(ha)) {
2531
			sense_data += rsp_info_len;
2532 2533
			par_sense_len -= rsp_info_len;
		}
2534
		if (rsp_info_len > 3 && rsp_info[3]) {
2535
			ql_dbg(ql_dbg_io, fcport->vha, 0x3019,
2536 2537
			    "FCP I/O protocol failure (0x%x/0x%x).\n",
			    rsp_info_len, rsp_info[3]);
L
Linus Torvalds 已提交
2538

2539
			res = DID_BUS_BUSY << 16;
2540
			goto out;
L
Linus Torvalds 已提交
2541 2542 2543
		}
	}

2544 2545 2546 2547 2548
	/* Check for overrun. */
	if (IS_FWI2_CAPABLE(ha) && comp_status == CS_COMPLETE &&
	    scsi_status & SS_RESIDUAL_OVER)
		comp_status = CS_DATA_OVERRUN;

2549 2550 2551 2552 2553 2554 2555 2556
	/*
	 * Check retry_delay_timer value if we receive a busy or
	 * queue full.
	 */
	if (lscsi_status == SAM_STAT_TASK_SET_FULL ||
	    lscsi_status == SAM_STAT_BUSY)
		qla2x00_set_retry_delay_timestamp(fcport, retry_delay);

L
Linus Torvalds 已提交
2557 2558 2559 2560 2561
	/*
	 * Based on Host and scsi status generate status code for Linux
	 */
	switch (comp_status) {
	case CS_COMPLETE:
2562
	case CS_QUEUE_FULL:
L
Linus Torvalds 已提交
2563
		if (scsi_status == 0) {
2564
			res = DID_OK << 16;
L
Linus Torvalds 已提交
2565 2566 2567
			break;
		}
		if (scsi_status & (SS_RESIDUAL_UNDER | SS_RESIDUAL_OVER)) {
2568
			resid = resid_len;
2569
			scsi_set_resid(cp, resid);
2570 2571

			if (!lscsi_status &&
2572
			    ((unsigned)(scsi_bufflen(cp) - resid) <
2573
			     cp->underflow)) {
2574
				ql_dbg(ql_dbg_io, fcport->vha, 0x301a,
2575
				    "Mid-layer underflow detected (0x%x of 0x%x bytes).\n",
2576
				    resid, scsi_bufflen(cp));
2577

2578
				res = DID_ERROR << 16;
2579 2580
				break;
			}
L
Linus Torvalds 已提交
2581
		}
2582
		res = DID_OK << 16 | lscsi_status;
L
Linus Torvalds 已提交
2583

2584
		if (lscsi_status == SAM_STAT_TASK_SET_FULL) {
2585
			ql_dbg(ql_dbg_io, fcport->vha, 0x301b,
2586
			    "QUEUE FULL detected.\n");
2587 2588
			break;
		}
2589
		logit = 0;
L
Linus Torvalds 已提交
2590 2591 2592
		if (lscsi_status != SS_CHECK_CONDITION)
			break;

2593
		memset(cp->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
L
Linus Torvalds 已提交
2594 2595 2596
		if (!(scsi_status & SS_SENSE_LEN_VALID))
			break;

2597
		qla2x00_handle_sense(sp, sense_data, par_sense_len, sense_len,
2598
		    rsp, res);
L
Linus Torvalds 已提交
2599 2600 2601
		break;

	case CS_DATA_UNDERRUN:
2602
		/* Use F/W calculated residual length. */
2603 2604 2605 2606
		resid = IS_FWI2_CAPABLE(ha) ? fw_resid_len : resid_len;
		scsi_set_resid(cp, resid);
		if (scsi_status & SS_RESIDUAL_UNDER) {
			if (IS_FWI2_CAPABLE(ha) && fw_resid_len != resid_len) {
2607
				ql_dbg(ql_dbg_io, fcport->vha, 0x301d,
2608
				    "Dropped frame(s) detected (0x%x of 0x%x bytes).\n",
2609
				    resid, scsi_bufflen(cp));
2610

2611
				res = DID_ERROR << 16 | lscsi_status;
2612
				goto check_scsi_status;
2613
			}
2614

2615 2616 2617
			if (!lscsi_status &&
			    ((unsigned)(scsi_bufflen(cp) - resid) <
			    cp->underflow)) {
2618
				ql_dbg(ql_dbg_io, fcport->vha, 0x301e,
2619
				    "Mid-layer underflow detected (0x%x of 0x%x bytes).\n",
2620
				    resid, scsi_bufflen(cp));
2621

2622
				res = DID_ERROR << 16;
2623 2624
				break;
			}
2625 2626 2627 2628 2629 2630 2631
		} else if (lscsi_status != SAM_STAT_TASK_SET_FULL &&
			    lscsi_status != SAM_STAT_BUSY) {
			/*
			 * scsi status of task set and busy are considered to be
			 * task not completed.
			 */

2632
			ql_dbg(ql_dbg_io, fcport->vha, 0x301f,
2633 2634
			    "Dropped frame(s) detected (0x%x of 0x%x bytes).\n",
			    resid, scsi_bufflen(cp));
2635

2636
			res = DID_ERROR << 16 | lscsi_status;
2637
			goto check_scsi_status;
2638 2639 2640 2641
		} else {
			ql_dbg(ql_dbg_io, fcport->vha, 0x3030,
			    "scsi_status: 0x%x, lscsi_status: 0x%x\n",
			    scsi_status, lscsi_status);
L
Linus Torvalds 已提交
2642 2643
		}

2644
		res = DID_OK << 16 | lscsi_status;
2645
		logit = 0;
2646

2647
check_scsi_status:
L
Linus Torvalds 已提交
2648
		/*
A
Andrew Vasquez 已提交
2649
		 * Check to see if SCSI Status is non zero. If so report SCSI
L
Linus Torvalds 已提交
2650 2651 2652
		 * Status.
		 */
		if (lscsi_status != 0) {
2653
			if (lscsi_status == SAM_STAT_TASK_SET_FULL) {
2654
				ql_dbg(ql_dbg_io, fcport->vha, 0x3020,
2655
				    "QUEUE FULL detected.\n");
2656
				logit = 1;
2657 2658
				break;
			}
L
Linus Torvalds 已提交
2659 2660 2661
			if (lscsi_status != SS_CHECK_CONDITION)
				break;

2662
			memset(cp->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
L
Linus Torvalds 已提交
2663 2664 2665
			if (!(scsi_status & SS_SENSE_LEN_VALID))
				break;

2666
			qla2x00_handle_sense(sp, sense_data, par_sense_len,
2667
			    sense_len, rsp, res);
L
Linus Torvalds 已提交
2668 2669 2670 2671 2672 2673 2674 2675
		}
		break;

	case CS_PORT_LOGGED_OUT:
	case CS_PORT_CONFIG_CHG:
	case CS_PORT_BUSY:
	case CS_INCOMPLETE:
	case CS_PORT_UNAVAILABLE:
2676
	case CS_TIMEOUT:
2677 2678
	case CS_RESET:

2679 2680 2681 2682 2683
		/*
		 * We are going to have the fc class block the rport
		 * while we try to recover so instruct the mid layer
		 * to requeue until the class decides how to handle this.
		 */
2684
		res = DID_TRANSPORT_DISRUPTED << 16;
2685 2686 2687 2688 2689 2690 2691 2692 2693

		if (comp_status == CS_TIMEOUT) {
			if (IS_FWI2_CAPABLE(ha))
				break;
			else if ((le16_to_cpu(sts->status_flags) &
			    SF_LOGOUT_SENT) == 0)
				break;
		}

2694 2695 2696 2697 2698 2699 2700 2701
		if (atomic_read(&fcport->state) == FCS_ONLINE) {
			ql_dbg(ql_dbg_disc, fcport->vha, 0x3021,
				"Port to be marked lost on fcport=%02x%02x%02x, current "
				"port state= %s comp_status %x.\n", fcport->d_id.b.domain,
				fcport->d_id.b.area, fcport->d_id.b.al_pa,
				port_state_str[atomic_read(&fcport->state)],
				comp_status);

2702
			qla2x00_mark_device_lost(fcport->vha, fcport, 1, 1);
2703 2704 2705
			qlt_schedule_sess_for_deletion_lock(fcport);
		}

L
Linus Torvalds 已提交
2706 2707 2708
		break;

	case CS_ABORTED:
2709
		res = DID_RESET << 16;
L
Linus Torvalds 已提交
2710
		break;
2711 2712

	case CS_DIF_ERROR:
2713
		logit = qla2x00_handle_dif_error(sp, sts24);
2714
		res = cp->result;
2715
		break;
2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728

	case CS_TRANSPORT:
		res = DID_ERROR << 16;

		if (!IS_PI_SPLIT_DET_CAPABLE(ha))
			break;

		if (state_flags & BIT_4)
			scmd_printk(KERN_WARNING, cp,
			    "Unsupported device '%s' found.\n",
			    cp->device->vendor);
		break;

L
Linus Torvalds 已提交
2729
	default:
2730
		res = DID_ERROR << 16;
L
Linus Torvalds 已提交
2731 2732 2733
		break;
	}

2734 2735
out:
	if (logit)
2736
		ql_dbg(ql_dbg_io, fcport->vha, 0x3022,
H
Hannes Reinecke 已提交
2737
		    "FCP command status: 0x%x-0x%x (0x%x) nexus=%ld:%d:%llu "
2738
		    "portid=%02x%02x%02x oxid=0x%x cdb=%10phN len=0x%x "
2739
		    "rsp_info=0x%x resid=0x%x fw_resid=0x%x sp=%p cp=%p.\n",
2740
		    comp_status, scsi_status, res, vha->host_no,
2741 2742
		    cp->device->id, cp->device->lun, fcport->d_id.b.domain,
		    fcport->d_id.b.area, fcport->d_id.b.al_pa, ox_id,
2743
		    cp->cmnd, scsi_bufflen(cp), rsp_info_len,
2744
		    resid_len, fw_resid_len, sp, cp);
2745

2746
	if (rsp->status_srb == NULL)
2747
		sp->done(sp, res);
L
Linus Torvalds 已提交
2748 2749 2750 2751 2752 2753 2754 2755 2756 2757
}

/**
 * qla2x00_status_cont_entry() - Process a Status Continuations entry.
 * @ha: SCSI driver HA context
 * @pkt: Entry pointer
 *
 * Extended sense data.
 */
static void
2758
qla2x00_status_cont_entry(struct rsp_que *rsp, sts_cont_entry_t *pkt)
L
Linus Torvalds 已提交
2759
{
2760
	uint8_t	sense_sz = 0;
2761
	struct qla_hw_data *ha = rsp->hw;
2762
	struct scsi_qla_host *vha = pci_get_drvdata(ha->pdev);
2763
	srb_t *sp = rsp->status_srb;
L
Linus Torvalds 已提交
2764
	struct scsi_cmnd *cp;
2765 2766
	uint32_t sense_len;
	uint8_t *sense_ptr;
L
Linus Torvalds 已提交
2767

2768 2769
	if (!sp || !GET_CMD_SENSE_LEN(sp))
		return;
L
Linus Torvalds 已提交
2770

2771 2772
	sense_len = GET_CMD_SENSE_LEN(sp);
	sense_ptr = GET_CMD_SENSE_PTR(sp);
L
Linus Torvalds 已提交
2773

2774 2775 2776 2777
	cp = GET_CMD_SP(sp);
	if (cp == NULL) {
		ql_log(ql_log_warn, vha, 0x3025,
		    "cmd is NULL: already returned to OS (sp=%p).\n", sp);
L
Linus Torvalds 已提交
2778

2779 2780
		rsp->status_srb = NULL;
		return;
L
Linus Torvalds 已提交
2781 2782
	}

2783 2784 2785 2786
	if (sense_len > sizeof(pkt->data))
		sense_sz = sizeof(pkt->data);
	else
		sense_sz = sense_len;
2787

2788 2789 2790 2791 2792 2793
	/* Move sense data. */
	if (IS_FWI2_CAPABLE(ha))
		host_to_fcp_swap(pkt->data, sizeof(pkt->data));
	memcpy(sense_ptr, pkt->data, sense_sz);
	ql_dump_buffer(ql_dbg_io + ql_dbg_buffer, vha, 0x302c,
		sense_ptr, sense_sz);
2794

2795 2796
	sense_len -= sense_sz;
	sense_ptr += sense_sz;
2797

2798 2799 2800 2801 2802 2803
	SET_CMD_SENSE_PTR(sp, sense_ptr);
	SET_CMD_SENSE_LEN(sp, sense_len);

	/* Place command on done queue. */
	if (sense_len == 0) {
		rsp->status_srb = NULL;
2804
		sp->done(sp, cp->result);
2805 2806 2807
	}
}

L
Linus Torvalds 已提交
2808 2809 2810 2811
/**
 * qla2x00_error_entry() - Process an error entry.
 * @ha: SCSI driver HA context
 * @pkt: Entry pointer
2812
 * return : 1=allow further error analysis. 0=no additional error analysis.
L
Linus Torvalds 已提交
2813
 */
2814
static int
2815
qla2x00_error_entry(scsi_qla_host_t *vha, struct rsp_que *rsp, sts_entry_t *pkt)
L
Linus Torvalds 已提交
2816 2817
{
	srb_t *sp;
2818
	struct qla_hw_data *ha = vha->hw;
2819
	const char func[] = "ERROR-IOCB";
2820
	uint16_t que = MSW(pkt->handle);
2821
	struct req_que *req = NULL;
2822
	int res = DID_ERROR << 16;
2823

2824
	ql_dbg(ql_dbg_async, vha, 0x502a,
2825 2826
	    "iocb type %xh with error status %xh, handle %xh, rspq id %d\n",
	    pkt->entry_type, pkt->entry_status, pkt->handle, rsp->id);
2827

2828 2829 2830 2831 2832
	if (que >= ha->max_req_queues || !ha->req_q_map[que])
		goto fatal;

	req = ha->req_q_map[que];

2833 2834
	if (pkt->entry_status & RF_BUSY)
		res = DID_BUS_BUSY << 16;
L
Linus Torvalds 已提交
2835

2836 2837
	if ((pkt->handle & ~QLA_TGT_HANDLE_MASK) == QLA_TGT_SKIP_HANDLE)
		return 0;
2838

2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859
	switch (pkt->entry_type) {
	case NOTIFY_ACK_TYPE:
	case STATUS_TYPE:
	case STATUS_CONT_TYPE:
	case LOGINOUT_PORT_IOCB_TYPE:
	case CT_IOCB_TYPE:
	case ELS_IOCB_TYPE:
	case ABORT_IOCB_TYPE:
	case MBX_IOCB_TYPE:
		sp = qla2x00_get_sp_from_handle(vha, func, req, pkt);
		if (sp) {
			sp->done(sp, res);
			return 0;
		}
		break;

	case ABTS_RESP_24XX:
	case CTIO_TYPE7:
	case CTIO_CRC2:
	default:
		return 1;
L
Linus Torvalds 已提交
2860
	}
2861 2862
fatal:
	ql_log(ql_log_warn, vha, 0x5030,
2863
	    "Error entry - invalid handle/queue (%04x).\n", que);
2864
	return 0;
L
Linus Torvalds 已提交
2865 2866
}

2867 2868 2869 2870 2871 2872
/**
 * qla24xx_mbx_completion() - Process mailbox command completions.
 * @ha: SCSI driver HA context
 * @mb0: Mailbox0 register
 */
static void
2873
qla24xx_mbx_completion(scsi_qla_host_t *vha, uint16_t mb0)
2874 2875
{
	uint16_t	cnt;
2876
	uint32_t	mboxes;
2877
	uint16_t __iomem *wptr;
2878
	struct qla_hw_data *ha = vha->hw;
2879 2880
	struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;

2881 2882 2883
	/* Read all mbox registers? */
	mboxes = (1 << ha->mbx_count) - 1;
	if (!ha->mcp)
2884
		ql_dbg(ql_dbg_async, vha, 0x504e, "MBX pointer ERROR.\n");
2885 2886 2887
	else
		mboxes = ha->mcp->in_mb;

2888 2889 2890
	/* Load return mailbox registers. */
	ha->flags.mbox_int = 1;
	ha->mailbox_out[0] = mb0;
2891
	mboxes >>= 1;
2892 2893 2894
	wptr = (uint16_t __iomem *)&reg->mailbox1;

	for (cnt = 1; cnt < ha->mbx_count; cnt++) {
2895 2896 2897 2898
		if (mboxes & BIT_0)
			ha->mailbox_out[cnt] = RD_REG_WORD(wptr);

		mboxes >>= 1;
2899 2900 2901 2902
		wptr++;
	}
}

2903 2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914 2915
static void
qla24xx_abort_iocb_entry(scsi_qla_host_t *vha, struct req_que *req,
	struct abort_entry_24xx *pkt)
{
	const char func[] = "ABT_IOCB";
	srb_t *sp;
	struct srb_iocb *abt;

	sp = qla2x00_get_sp_from_handle(vha, func, req, pkt);
	if (!sp)
		return;

	abt = &sp->u.iocb_cmd;
2916
	abt->u.abt.comp_status = le16_to_cpu(pkt->nport_handle);
2917
	sp->done(sp, 0);
2918 2919
}

2920 2921
void qla24xx_nvme_ls4_iocb(struct scsi_qla_host *vha,
    struct pt_ls4_request *pkt, struct req_que *req)
2922 2923 2924 2925 2926 2927 2928 2929 2930 2931 2932 2933 2934
{
	srb_t *sp;
	const char func[] = "LS4_IOCB";
	uint16_t comp_status;

	sp = qla2x00_get_sp_from_handle(vha, func, req, pkt);
	if (!sp)
		return;

	comp_status = le16_to_cpu(pkt->status);
	sp->done(sp, comp_status);
}

2935 2936 2937 2938
/**
 * qla24xx_process_response_queue() - Process response queue entries.
 * @ha: SCSI driver HA context
 */
2939 2940
void qla24xx_process_response_queue(struct scsi_qla_host *vha,
	struct rsp_que *rsp)
2941 2942
{
	struct sts_entry_24xx *pkt;
2943
	struct qla_hw_data *ha = vha->hw;
2944

2945
	if (!ha->flags.fw_started)
2946 2947
		return;

2948 2949 2950
	if (rsp->qpair->cpuid != smp_processor_id())
		qla_cpu_update(rsp->qpair, smp_processor_id());

2951 2952
	while (rsp->ring_ptr->signature != RESPONSE_PROCESSED) {
		pkt = (struct sts_entry_24xx *)rsp->ring_ptr;
2953

2954 2955 2956 2957
		rsp->ring_index++;
		if (rsp->ring_index == rsp->length) {
			rsp->ring_index = 0;
			rsp->ring_ptr = rsp->ring;
2958
		} else {
2959
			rsp->ring_ptr++;
2960 2961 2962
		}

		if (pkt->entry_status != 0) {
2963
			if (qla2x00_error_entry(vha, rsp, (sts_entry_t *) pkt))
2964
				goto process_err;
2965

2966 2967 2968 2969
			((response_t *)pkt)->signature = RESPONSE_PROCESSED;
			wmb();
			continue;
		}
2970
process_err:
2971 2972 2973

		switch (pkt->entry_type) {
		case STATUS_TYPE:
2974
			qla2x00_status_entry(vha, rsp, pkt);
2975 2976
			break;
		case STATUS_CONT_TYPE:
2977
			qla2x00_status_cont_entry(rsp, (sts_cont_entry_t *)pkt);
2978
			break;
2979
		case VP_RPT_ID_IOCB_TYPE:
2980
			qla24xx_report_id_acquisition(vha,
2981 2982
			    (struct vp_rpt_id_entry_24xx *)pkt);
			break;
2983 2984 2985 2986
		case LOGINOUT_PORT_IOCB_TYPE:
			qla24xx_logio_entry(vha, rsp->req,
			    (struct logio_entry_24xx *)pkt);
			break;
2987
		case CT_IOCB_TYPE:
2988 2989
			qla24xx_els_ct_entry(vha, rsp->req, pkt, CT_IOCB_TYPE);
			break;
2990
		case ELS_IOCB_TYPE:
2991 2992
			qla24xx_els_ct_entry(vha, rsp->req, pkt, ELS_IOCB_TYPE);
			break;
2993
		case ABTS_RECV_24XX:
2994 2995
			if (IS_QLA83XX(ha) || IS_QLA27XX(ha)) {
				/* ensure that the ATIO queue is empty */
2996 2997
				qlt_handle_abts_recv(vha, rsp,
				    (response_t *)pkt);
2998 2999 3000 3001
				break;
			} else {
				qlt_24xx_process_atio_queue(vha, 1);
			}
3002
			/* fall through */
3003 3004
		case ABTS_RESP_24XX:
		case CTIO_TYPE7:
3005
		case CTIO_CRC2:
3006
			qlt_response_pkt_all_vps(vha, rsp, (response_t *)pkt);
3007
			break;
3008 3009 3010 3011
		case PT_LS4_REQUEST:
			qla24xx_nvme_ls4_iocb(vha, (struct pt_ls4_request *)pkt,
			    rsp->req);
			break;
3012 3013
		case NOTIFY_ACK_TYPE:
			if (pkt->handle == QLA_TGT_SKIP_HANDLE)
3014 3015
				qlt_response_pkt_all_vps(vha, rsp,
				    (response_t *)pkt);
3016 3017 3018 3019
			else
				qla24xxx_nack_iocb_entry(vha, rsp->req,
					(struct nack_to_isp *)pkt);
			break;
3020 3021 3022 3023 3024
		case MARKER_TYPE:
			/* Do nothing in this case, this check is to prevent it
			 * from falling into default case
			 */
			break;
3025 3026 3027 3028
		case ABORT_IOCB_TYPE:
			qla24xx_abort_iocb_entry(vha, rsp->req,
			    (struct abort_entry_24xx *)pkt);
			break;
3029 3030 3031 3032
		case MBX_IOCB_TYPE:
			qla24xx_mbx_iocb_entry(vha, rsp->req,
			    (struct mbx_24xx_entry *)pkt);
			break;
3033 3034 3035 3036
		case VP_CTRL_IOCB_TYPE:
			qla_ctrlvp_completed(vha, rsp->req,
			    (struct vp_ctrl_entry_24xx *)pkt);
			break;
3037 3038
		default:
			/* Type Not Supported. */
3039 3040
			ql_dbg(ql_dbg_async, vha, 0x5042,
			    "Received unknown response pkt type %x "
3041
			    "entry status=%x.\n",
3042
			    pkt->entry_type, pkt->entry_status);
3043 3044 3045 3046 3047 3048 3049
			break;
		}
		((response_t *)pkt)->signature = RESPONSE_PROCESSED;
		wmb();
	}

	/* Adjust ring index */
3050
	if (IS_P3P_TYPE(ha)) {
3051 3052
		struct device_reg_82xx __iomem *reg = &ha->iobase->isp82;
		WRT_REG_DWORD(&reg->rsp_q_out[0], rsp->ring_index);
3053
	} else {
3054
		WRT_REG_DWORD(rsp->rsp_q_out, rsp->ring_index);
3055
	}
3056 3057
}

3058
static void
3059
qla2xxx_check_risc_status(scsi_qla_host_t *vha)
3060 3061 3062
{
	int rval;
	uint32_t cnt;
3063
	struct qla_hw_data *ha = vha->hw;
3064 3065
	struct device_reg_24xx __iomem *reg = &ha->iobase->isp24;

3066 3067
	if (!IS_QLA25XX(ha) && !IS_QLA81XX(ha) && !IS_QLA83XX(ha) &&
	    !IS_QLA27XX(ha))
3068 3069 3070 3071 3072 3073 3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084
		return;

	rval = QLA_SUCCESS;
	WRT_REG_DWORD(&reg->iobase_addr, 0x7C00);
	RD_REG_DWORD(&reg->iobase_addr);
	WRT_REG_DWORD(&reg->iobase_window, 0x0001);
	for (cnt = 10000; (RD_REG_DWORD(&reg->iobase_window) & BIT_0) == 0 &&
	    rval == QLA_SUCCESS; cnt--) {
		if (cnt) {
			WRT_REG_DWORD(&reg->iobase_window, 0x0001);
			udelay(10);
		} else
			rval = QLA_FUNCTION_TIMEOUT;
	}
	if (rval == QLA_SUCCESS)
		goto next_test;

3085
	rval = QLA_SUCCESS;
3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099
	WRT_REG_DWORD(&reg->iobase_window, 0x0003);
	for (cnt = 100; (RD_REG_DWORD(&reg->iobase_window) & BIT_0) == 0 &&
	    rval == QLA_SUCCESS; cnt--) {
		if (cnt) {
			WRT_REG_DWORD(&reg->iobase_window, 0x0003);
			udelay(10);
		} else
			rval = QLA_FUNCTION_TIMEOUT;
	}
	if (rval != QLA_SUCCESS)
		goto done;

next_test:
	if (RD_REG_DWORD(&reg->iobase_c8) & BIT_3)
3100 3101
		ql_log(ql_log_info, vha, 0x504c,
		    "Additional code -- 0x55AA.\n");
3102 3103 3104 3105 3106 3107

done:
	WRT_REG_DWORD(&reg->iobase_window, 0x0000);
	RD_REG_DWORD(&reg->iobase_window);
}

3108
/**
3109
 * qla24xx_intr_handler() - Process interrupts for the ISP23xx and ISP24xx.
3110 3111 3112 3113 3114 3115 3116 3117
 * @irq:
 * @dev_id: SCSI driver HA context
 *
 * Called by system whenever the host adapter generates an interrupt.
 *
 * Returns handled flag.
 */
irqreturn_t
3118
qla24xx_intr_handler(int irq, void *dev_id)
3119
{
3120 3121
	scsi_qla_host_t	*vha;
	struct qla_hw_data *ha;
3122 3123 3124 3125 3126
	struct device_reg_24xx __iomem *reg;
	int		status;
	unsigned long	iter;
	uint32_t	stat;
	uint32_t	hccr;
3127
	uint16_t	mb[8];
3128
	struct rsp_que *rsp;
3129
	unsigned long	flags;
3130

3131 3132
	rsp = (struct rsp_que *) dev_id;
	if (!rsp) {
3133 3134
		ql_log(ql_log_info, NULL, 0x5059,
		    "%s: NULL response queue pointer.\n", __func__);
3135 3136 3137
		return IRQ_NONE;
	}

3138
	ha = rsp->hw;
3139 3140 3141
	reg = &ha->iobase->isp24;
	status = 0;

3142 3143 3144
	if (unlikely(pci_channel_offline(ha->pdev)))
		return IRQ_HANDLED;

3145
	spin_lock_irqsave(&ha->hardware_lock, flags);
3146
	vha = pci_get_drvdata(ha->pdev);
3147 3148
	for (iter = 50; iter--; ) {
		stat = RD_REG_DWORD(&reg->host_status);
3149
		if (qla2x00_check_reg32_for_disconnect(vha, stat))
3150
			break;
3151
		if (stat & HSRX_RISC_PAUSED) {
3152
			if (unlikely(pci_channel_offline(ha->pdev)))
3153 3154
				break;

3155 3156
			hccr = RD_REG_DWORD(&reg->hccr);

3157 3158 3159
			ql_log(ql_log_warn, vha, 0x504b,
			    "RISC paused -- HCCR=%x, Dumping firmware.\n",
			    hccr);
3160

3161
			qla2xxx_check_risc_status(vha);
3162

3163 3164
			ha->isp_ops->fw_dump(vha, 1);
			set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
3165 3166 3167 3168 3169
			break;
		} else if ((stat & HSRX_RISC_INT) == 0)
			break;

		switch (stat & 0xff) {
3170 3171 3172 3173
		case INTR_ROM_MB_SUCCESS:
		case INTR_ROM_MB_FAILED:
		case INTR_MB_SUCCESS:
		case INTR_MB_FAILED:
3174
			qla24xx_mbx_completion(vha, MSW(stat));
3175 3176 3177
			status |= MBX_INTERRUPT;

			break;
3178
		case INTR_ASYNC_EVENT:
3179 3180 3181 3182
			mb[0] = MSW(stat);
			mb[1] = RD_REG_WORD(&reg->mailbox1);
			mb[2] = RD_REG_WORD(&reg->mailbox2);
			mb[3] = RD_REG_WORD(&reg->mailbox3);
3183
			qla2x00_async_event(vha, rsp, mb);
3184
			break;
3185 3186
		case INTR_RSP_QUE_UPDATE:
		case INTR_RSP_QUE_UPDATE_83XX:
3187
			qla24xx_process_response_queue(vha, rsp);
3188
			break;
3189
		case INTR_ATIO_QUE_UPDATE_27XX:
3190 3191 3192 3193 3194
		case INTR_ATIO_QUE_UPDATE:{
			unsigned long flags2;
			spin_lock_irqsave(&ha->tgt.atio_lock, flags2);
			qlt_24xx_process_atio_queue(vha, 1);
			spin_unlock_irqrestore(&ha->tgt.atio_lock, flags2);
3195
			break;
3196 3197 3198 3199 3200 3201 3202
		}
		case INTR_ATIO_RSP_QUE_UPDATE: {
			unsigned long flags2;
			spin_lock_irqsave(&ha->tgt.atio_lock, flags2);
			qlt_24xx_process_atio_queue(vha, 1);
			spin_unlock_irqrestore(&ha->tgt.atio_lock, flags2);

3203 3204
			qla24xx_process_response_queue(vha, rsp);
			break;
3205
		}
3206
		default:
3207 3208
			ql_dbg(ql_dbg_async, vha, 0x504f,
			    "Unrecognized interrupt type (%d).\n", stat * 0xff);
3209 3210 3211 3212
			break;
		}
		WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_INT);
		RD_REG_DWORD_RELAXED(&reg->hccr);
3213 3214
		if (unlikely(IS_QLA83XX(ha) && (ha->pdev->revision == 1)))
			ndelay(3500);
3215
	}
3216
	qla2x00_handle_mbx_completion(ha, status);
3217
	spin_unlock_irqrestore(&ha->hardware_lock, flags);
3218 3219 3220 3221

	return IRQ_HANDLED;
}

3222 3223 3224
static irqreturn_t
qla24xx_msix_rsp_q(int irq, void *dev_id)
{
3225 3226
	struct qla_hw_data *ha;
	struct rsp_que *rsp;
3227
	struct device_reg_24xx __iomem *reg;
3228
	struct scsi_qla_host *vha;
3229
	unsigned long flags;
3230

3231 3232
	rsp = (struct rsp_que *) dev_id;
	if (!rsp) {
3233 3234
		ql_log(ql_log_info, NULL, 0x505a,
		    "%s: NULL response queue pointer.\n", __func__);
3235 3236 3237
		return IRQ_NONE;
	}
	ha = rsp->hw;
3238 3239
	reg = &ha->iobase->isp24;

3240
	spin_lock_irqsave(&ha->hardware_lock, flags);
3241

3242
	vha = pci_get_drvdata(ha->pdev);
3243
	qla24xx_process_response_queue(vha, rsp);
3244
	if (!ha->flags.disable_msix_handshake) {
3245 3246 3247
		WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_INT);
		RD_REG_DWORD_RELAXED(&reg->hccr);
	}
3248
	spin_unlock_irqrestore(&ha->hardware_lock, flags);
3249 3250 3251 3252 3253 3254 3255

	return IRQ_HANDLED;
}

static irqreturn_t
qla24xx_msix_default(int irq, void *dev_id)
{
3256 3257 3258
	scsi_qla_host_t	*vha;
	struct qla_hw_data *ha;
	struct rsp_que *rsp;
3259 3260 3261 3262
	struct device_reg_24xx __iomem *reg;
	int		status;
	uint32_t	stat;
	uint32_t	hccr;
3263
	uint16_t	mb[8];
3264
	unsigned long flags;
3265

3266 3267
	rsp = (struct rsp_que *) dev_id;
	if (!rsp) {
3268 3269
		ql_log(ql_log_info, NULL, 0x505c,
		    "%s: NULL response queue pointer.\n", __func__);
3270 3271 3272
		return IRQ_NONE;
	}
	ha = rsp->hw;
3273 3274 3275
	reg = &ha->iobase->isp24;
	status = 0;

3276
	spin_lock_irqsave(&ha->hardware_lock, flags);
3277
	vha = pci_get_drvdata(ha->pdev);
3278
	do {
3279
		stat = RD_REG_DWORD(&reg->host_status);
3280
		if (qla2x00_check_reg32_for_disconnect(vha, stat))
3281
			break;
3282
		if (stat & HSRX_RISC_PAUSED) {
3283
			if (unlikely(pci_channel_offline(ha->pdev)))
3284 3285
				break;

3286 3287
			hccr = RD_REG_DWORD(&reg->hccr);

3288 3289 3290
			ql_log(ql_log_info, vha, 0x5050,
			    "RISC paused -- HCCR=%x, Dumping firmware.\n",
			    hccr);
3291

3292
			qla2xxx_check_risc_status(vha);
3293

3294 3295
			ha->isp_ops->fw_dump(vha, 1);
			set_bit(ISP_ABORT_NEEDED, &vha->dpc_flags);
3296 3297 3298 3299 3300
			break;
		} else if ((stat & HSRX_RISC_INT) == 0)
			break;

		switch (stat & 0xff) {
3301 3302 3303 3304
		case INTR_ROM_MB_SUCCESS:
		case INTR_ROM_MB_FAILED:
		case INTR_MB_SUCCESS:
		case INTR_MB_FAILED:
3305
			qla24xx_mbx_completion(vha, MSW(stat));
3306 3307 3308
			status |= MBX_INTERRUPT;

			break;
3309
		case INTR_ASYNC_EVENT:
3310 3311 3312 3313
			mb[0] = MSW(stat);
			mb[1] = RD_REG_WORD(&reg->mailbox1);
			mb[2] = RD_REG_WORD(&reg->mailbox2);
			mb[3] = RD_REG_WORD(&reg->mailbox3);
3314
			qla2x00_async_event(vha, rsp, mb);
3315
			break;
3316 3317
		case INTR_RSP_QUE_UPDATE:
		case INTR_RSP_QUE_UPDATE_83XX:
3318
			qla24xx_process_response_queue(vha, rsp);
3319
			break;
3320
		case INTR_ATIO_QUE_UPDATE_27XX:
3321 3322 3323 3324 3325
		case INTR_ATIO_QUE_UPDATE:{
			unsigned long flags2;
			spin_lock_irqsave(&ha->tgt.atio_lock, flags2);
			qlt_24xx_process_atio_queue(vha, 1);
			spin_unlock_irqrestore(&ha->tgt.atio_lock, flags2);
3326
			break;
3327 3328 3329 3330 3331 3332 3333
		}
		case INTR_ATIO_RSP_QUE_UPDATE: {
			unsigned long flags2;
			spin_lock_irqsave(&ha->tgt.atio_lock, flags2);
			qlt_24xx_process_atio_queue(vha, 1);
			spin_unlock_irqrestore(&ha->tgt.atio_lock, flags2);

3334 3335
			qla24xx_process_response_queue(vha, rsp);
			break;
3336
		}
3337
		default:
3338 3339
			ql_dbg(ql_dbg_async, vha, 0x5051,
			    "Unrecognized interrupt type (%d).\n", stat & 0xff);
3340 3341 3342
			break;
		}
		WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_INT);
3343
	} while (0);
3344
	qla2x00_handle_mbx_completion(ha, status);
3345
	spin_unlock_irqrestore(&ha->hardware_lock, flags);
3346 3347 3348 3349

	return IRQ_HANDLED;
}

3350 3351 3352 3353 3354 3355 3356 3357 3358 3359 3360 3361 3362 3363 3364 3365 3366 3367 3368 3369 3370 3371 3372 3373 3374 3375 3376 3377 3378
irqreturn_t
qla2xxx_msix_rsp_q(int irq, void *dev_id)
{
	struct qla_hw_data *ha;
	struct qla_qpair *qpair;
	struct device_reg_24xx __iomem *reg;
	unsigned long flags;

	qpair = dev_id;
	if (!qpair) {
		ql_log(ql_log_info, NULL, 0x505b,
		    "%s: NULL response queue pointer.\n", __func__);
		return IRQ_NONE;
	}
	ha = qpair->hw;

	/* Clear the interrupt, if enabled, for this response queue */
	if (unlikely(!ha->flags.disable_msix_handshake)) {
		reg = &ha->iobase->isp24;
		spin_lock_irqsave(&ha->hardware_lock, flags);
		WRT_REG_DWORD(&reg->hccr, HCCRX_CLR_RISC_INT);
		spin_unlock_irqrestore(&ha->hardware_lock, flags);
	}

	queue_work(ha->wq, &qpair->q_work);

	return IRQ_HANDLED;
}

3379 3380 3381 3382
/* Interrupt handling helpers. */

struct qla_init_msix_entry {
	const char *name;
3383
	irq_handler_t handler;
3384 3385
};

3386
static const struct qla_init_msix_entry msix_entries[] = {
3387 3388 3389 3390
	{ "default", qla24xx_msix_default },
	{ "rsp_q", qla24xx_msix_rsp_q },
	{ "atio_q", qla83xx_msix_atio_q },
	{ "qpair_multiq", qla2xxx_msix_rsp_q },
3391 3392
};

3393
static const struct qla_init_msix_entry qla82xx_msix_entries[] = {
3394 3395 3396 3397
	{ "qla2xxx (default)", qla82xx_msix_default },
	{ "qla2xxx (rsp_q)", qla82xx_msix_rsp_q },
};

3398
static int
3399
qla24xx_enable_msix(struct qla_hw_data *ha, struct rsp_que *rsp)
3400 3401 3402
{
	int i, ret;
	struct qla_msix_entry *qentry;
3403
	scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev);
3404
	int min_vecs = QLA_BASE_VECTORS;
3405 3406 3407 3408
	struct irq_affinity desc = {
		.pre_vectors = QLA_BASE_VECTORS,
	};

3409 3410
	if (QLA_TGT_MODE_ENABLED() && (ql2xenablemsix != 0) &&
	    IS_ATIO_MSIX_CAPABLE(ha)) {
3411
		desc.pre_vectors++;
3412 3413
		min_vecs++;
	}
3414

3415 3416 3417 3418 3419 3420 3421 3422
	if (USER_CTRL_IRQ(ha)) {
		/* user wants to control IRQ setting for target mode */
		ret = pci_alloc_irq_vectors(ha->pdev, min_vecs,
		    ha->msix_count, PCI_IRQ_MSIX);
	} else
		ret = pci_alloc_irq_vectors_affinity(ha->pdev, min_vecs,
		    ha->msix_count, PCI_IRQ_MSIX | PCI_IRQ_AFFINITY,
		    &desc);
3423

3424 3425 3426 3427 3428 3429 3430
	if (ret < 0) {
		ql_log(ql_log_fatal, vha, 0x00c7,
		    "MSI-X: Failed to enable support, "
		    "giving   up -- %d/%d.\n",
		    ha->msix_count, ret);
		goto msix_out;
	} else if (ret < ha->msix_count) {
3431 3432
		ql_log(ql_log_warn, vha, 0x00c6,
		    "MSI-X: Failed to enable support "
3433 3434
		     "with %d vectors, using %d vectors.\n",
		    ha->msix_count, ret);
Q
Quinn Tran 已提交
3435
		ha->msix_count = ret;
3436
		/* Recalculate queue values */
3437
		if (ha->mqiobase && (ql2xmqsupport || ql2xnvmeenable)) {
3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448 3449
			ha->max_req_queues = ha->msix_count - 1;

			/* ATIOQ needs 1 vector. That's 1 less QPair */
			if (QLA_TGT_MODE_ENABLED())
				ha->max_req_queues--;

			ha->max_rsp_queues = ha->max_req_queues;

			ha->max_qpairs = ha->max_req_queues - 1;
			ql_dbg_pci(ql_dbg_init, ha->pdev, 0x0190,
			    "Adjusted Max no of queues pairs: %d.\n", ha->max_qpairs);
		}
3450 3451 3452 3453
	}
	ha->msix_entries = kzalloc(sizeof(struct qla_msix_entry) *
				ha->msix_count, GFP_KERNEL);
	if (!ha->msix_entries) {
3454 3455
		ql_log(ql_log_fatal, vha, 0x00c8,
		    "Failed to allocate memory for ha->msix_entries.\n");
3456
		ret = -ENOMEM;
3457 3458 3459 3460
		goto msix_out;
	}
	ha->flags.msix_enabled = 1;

3461 3462
	for (i = 0; i < ha->msix_count; i++) {
		qentry = &ha->msix_entries[i];
3463 3464
		qentry->vector = pci_irq_vector(ha->pdev, i);
		qentry->entry = i;
3465
		qentry->have_irq = 0;
3466
		qentry->in_use = 0;
3467
		qentry->handle = NULL;
3468 3469
	}

3470
	/* Enable MSI-X vectors for the base queue */
3471
	for (i = 0; i < QLA_BASE_VECTORS; i++) {
3472
		qentry = &ha->msix_entries[i];
3473
		qentry->handle = rsp;
3474
		rsp->msix = qentry;
3475
		scnprintf(qentry->name, sizeof(qentry->name),
3476
		    "qla2xxx%lu_%s", vha->host_no, msix_entries[i].name);
3477
		if (IS_P3P_TYPE(ha))
3478 3479 3480
			ret = request_irq(qentry->vector,
				qla82xx_msix_entries[i].handler,
				0, qla82xx_msix_entries[i].name, rsp);
3481
		else
3482 3483
			ret = request_irq(qentry->vector,
				msix_entries[i].handler,
3484
				0, qentry->name, rsp);
3485 3486 3487
		if (ret)
			goto msix_register_fail;
		qentry->have_irq = 1;
3488
		qentry->in_use = 1;
3489 3490 3491 3492 3493 3494
	}

	/*
	 * If target mode is enable, also request the vector for the ATIO
	 * queue.
	 */
3495 3496
	if (QLA_TGT_MODE_ENABLED() && (ql2xenablemsix != 0) &&
	    IS_ATIO_MSIX_CAPABLE(ha)) {
3497
		qentry = &ha->msix_entries[QLA_ATIO_VECTOR];
3498
		rsp->msix = qentry;
3499 3500
		qentry->handle = rsp;
		scnprintf(qentry->name, sizeof(qentry->name),
3501 3502
		    "qla2xxx%lu_%s", vha->host_no,
		    msix_entries[QLA_ATIO_VECTOR].name);
3503
		qentry->in_use = 1;
3504
		ret = request_irq(qentry->vector,
3505
			msix_entries[QLA_ATIO_VECTOR].handler,
3506
			0, qentry->name, rsp);
3507
		qentry->have_irq = 1;
3508 3509
	}

3510 3511 3512 3513 3514
msix_register_fail:
	if (ret) {
		ql_log(ql_log_fatal, vha, 0x00cb,
		    "MSI-X: unable to register handler -- %x/%d.\n",
		    qentry->vector, ret);
3515
		qla2x00_free_irqs(vha);
3516 3517 3518 3519
		ha->mqenable = 0;
		goto msix_out;
	}

3520
	/* Enable MSI-X vector for response queue update for queue 0 */
3521
	if (IS_QLA83XX(ha) || IS_QLA27XX(ha)) {
3522
		if (ha->msixbase && ha->mqiobase &&
3523 3524
		    (ha->max_rsp_queues > 1 || ha->max_req_queues > 1 ||
		     ql2xmqsupport))
3525 3526
			ha->mqenable = 1;
	} else
3527 3528 3529
		if (ha->mqiobase &&
		    (ha->max_rsp_queues > 1 || ha->max_req_queues > 1 ||
		     ql2xmqsupport))
3530
			ha->mqenable = 1;
3531 3532 3533 3534 3535 3536
	ql_dbg(ql_dbg_multiq, vha, 0xc005,
	    "mqiobase=%p, max_rsp_queues=%d, max_req_queues=%d.\n",
	    ha->mqiobase, ha->max_rsp_queues, ha->max_req_queues);
	ql_dbg(ql_dbg_init, vha, 0x0055,
	    "mqiobase=%p, max_rsp_queues=%d, max_req_queues=%d.\n",
	    ha->mqiobase, ha->max_rsp_queues, ha->max_req_queues);
3537

3538 3539 3540 3541 3542
msix_out:
	return ret;
}

int
3543
qla2x00_request_irqs(struct qla_hw_data *ha, struct rsp_que *rsp)
3544
{
3545
	int ret = QLA_FUNCTION_FAILED;
3546
	device_reg_t *reg = ha->iobase;
3547
	scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev);
3548 3549

	/* If possible, enable MSI-X. */
3550 3551 3552
	if (ql2xenablemsix == 0 || (!IS_QLA2432(ha) && !IS_QLA2532(ha) &&
	    !IS_QLA8432(ha) && !IS_CNA_CAPABLE(ha) && !IS_QLA2031(ha) &&
	    !IS_QLAFX00(ha) && !IS_QLA27XX(ha)))
3553 3554
		goto skip_msi;

3555 3556 3557
	if (ql2xenablemsix == 2)
		goto skip_msix;

3558 3559 3560 3561
	if (ha->pdev->subsystem_vendor == PCI_VENDOR_ID_HP &&
		(ha->pdev->subsystem_device == 0x7040 ||
		ha->pdev->subsystem_device == 0x7041 ||
		ha->pdev->subsystem_device == 0x1705)) {
3562 3563
		ql_log(ql_log_warn, vha, 0x0034,
		    "MSI-X: Unsupported ISP 2432 SSVID/SSDID (0x%X,0x%X).\n",
3564
			ha->pdev->subsystem_vendor,
3565
			ha->pdev->subsystem_device);
3566 3567
		goto skip_msi;
	}
3568

3569
	if (IS_QLA2432(ha) && (ha->pdev->revision < QLA_MSIX_CHIP_REV_24XX)) {
3570 3571
		ql_log(ql_log_warn, vha, 0x0035,
		    "MSI-X; Unsupported ISP2432 (0x%X, 0x%X).\n",
3572
		    ha->pdev->revision, QLA_MSIX_CHIP_REV_24XX);
3573 3574 3575
		goto skip_msix;
	}

3576
	ret = qla24xx_enable_msix(ha, rsp);
3577
	if (!ret) {
3578 3579 3580
		ql_dbg(ql_dbg_init, vha, 0x0036,
		    "MSI-X: Enabled (0x%X, 0x%X).\n",
		    ha->chip_revision, ha->fw_attributes);
3581
		goto clear_risc_ints;
3582
	}
3583

3584
skip_msix:
3585

3586 3587 3588
	ql_log(ql_log_info, vha, 0x0037,
	    "Falling back-to MSI mode -%d.\n", ret);

3589
	if (!IS_QLA24XX(ha) && !IS_QLA2532(ha) && !IS_QLA8432(ha) &&
3590 3591
	    !IS_QLA8001(ha) && !IS_P3P_TYPE(ha) && !IS_QLAFX00(ha) &&
	    !IS_QLA27XX(ha))
3592 3593
		goto skip_msi;

3594
	ret = pci_alloc_irq_vectors(ha->pdev, 1, 1, PCI_IRQ_MSI);
3595
	if (!ret) {
3596 3597
		ql_dbg(ql_dbg_init, vha, 0x0038,
		    "MSI: Enabled.\n");
3598
		ha->flags.msi_enabled = 1;
3599
	} else
3600
		ql_log(ql_log_warn, vha, 0x0039,
3601 3602
		    "Falling back-to INTa mode -- %d.\n", ret);
skip_msi:
3603 3604 3605 3606 3607

	/* Skip INTx on ISP82xx. */
	if (!ha->flags.msi_enabled && IS_QLA82XX(ha))
		return QLA_FUNCTION_FAILED;

3608
	ret = request_irq(ha->pdev->irq, ha->isp_ops->intr_handler,
3609 3610
	    ha->flags.msi_enabled ? 0 : IRQF_SHARED,
	    QLA2XXX_DRIVER_NAME, rsp);
3611
	if (ret) {
3612
		ql_log(ql_log_warn, vha, 0x003a,
3613 3614
		    "Failed to reserve interrupt %d already in use.\n",
		    ha->pdev->irq);
3615
		goto fail;
3616
	} else if (!ha->flags.msi_enabled) {
3617 3618
		ql_dbg(ql_dbg_init, vha, 0x0125,
		    "INTa mode: Enabled.\n");
3619 3620
		ha->flags.mr_intr_valid = 1;
	}
3621

3622
clear_risc_ints:
3623 3624
	if (IS_FWI2_CAPABLE(ha) || IS_QLAFX00(ha))
		goto fail;
3625

3626
	spin_lock_irq(&ha->hardware_lock);
3627
	WRT_REG_WORD(&reg->isp.semaphore, 0);
3628
	spin_unlock_irq(&ha->hardware_lock);
3629

3630
fail:
3631 3632 3633 3634
	return ret;
}

void
3635
qla2x00_free_irqs(scsi_qla_host_t *vha)
3636
{
3637
	struct qla_hw_data *ha = vha->hw;
3638
	struct rsp_que *rsp;
3639 3640
	struct qla_msix_entry *qentry;
	int i;
3641 3642 3643 3644 3645 3646

	/*
	 * We need to check that ha->rsp_q_map is valid in case we are called
	 * from a probe failure context.
	 */
	if (!ha->rsp_q_map || !ha->rsp_q_map[0])
3647
		goto free_irqs;
3648
	rsp = ha->rsp_q_map[0];
3649

3650 3651 3652 3653 3654 3655 3656 3657 3658 3659 3660 3661 3662 3663 3664 3665
	if (ha->flags.msix_enabled) {
		for (i = 0; i < ha->msix_count; i++) {
			qentry = &ha->msix_entries[i];
			if (qentry->have_irq) {
				irq_set_affinity_notifier(qentry->vector, NULL);
				free_irq(pci_irq_vector(ha->pdev, i), qentry->handle);
			}
		}
		kfree(ha->msix_entries);
		ha->msix_entries = NULL;
		ha->flags.msix_enabled = 0;
		ql_dbg(ql_dbg_init, vha, 0x0042,
			"Disabled MSI-X.\n");
	} else {
		free_irq(pci_irq_vector(ha->pdev, 0), rsp);
	}
3666

3667
free_irqs:
3668
	pci_free_irq_vectors(ha->pdev);
3669
}
3670

3671 3672
int qla25xx_request_irq(struct qla_hw_data *ha, struct qla_qpair *qpair,
	struct qla_msix_entry *msix, int vector_type)
3673
{
3674
	const struct qla_init_msix_entry *intr = &msix_entries[vector_type];
3675
	scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev);
3676 3677
	int ret;

3678 3679 3680
	scnprintf(msix->name, sizeof(msix->name),
	    "qla2xxx%lu_qpair%d", vha->host_no, qpair->id);
	ret = request_irq(msix->vector, intr->handler, 0, msix->name, qpair);
3681
	if (ret) {
3682 3683 3684
		ql_log(ql_log_fatal, vha, 0x00e6,
		    "MSI-X: Unable to register handler -- %x/%d.\n",
		    msix->vector, ret);
3685 3686 3687
		return ret;
	}
	msix->have_irq = 1;
3688
	msix->handle = qpair;
3689 3690
	return ret;
}