xref: /openbmc/linux/drivers/scsi/ibmvscsi/ibmvfc.c (revision 8ffdff6a)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * ibmvfc.c -- driver for IBM Power Virtual Fibre Channel Adapter
4  *
5  * Written By: Brian King <brking@linux.vnet.ibm.com>, IBM Corporation
6  *
7  * Copyright (C) IBM Corporation, 2008
8  */
9 
10 #include <linux/module.h>
11 #include <linux/moduleparam.h>
12 #include <linux/dma-mapping.h>
13 #include <linux/dmapool.h>
14 #include <linux/delay.h>
15 #include <linux/interrupt.h>
16 #include <linux/kthread.h>
17 #include <linux/slab.h>
18 #include <linux/of.h>
19 #include <linux/pm.h>
20 #include <linux/stringify.h>
21 #include <linux/bsg-lib.h>
22 #include <asm/firmware.h>
23 #include <asm/irq.h>
24 #include <asm/rtas.h>
25 #include <asm/vio.h>
26 #include <scsi/scsi.h>
27 #include <scsi/scsi_cmnd.h>
28 #include <scsi/scsi_host.h>
29 #include <scsi/scsi_device.h>
30 #include <scsi/scsi_tcq.h>
31 #include <scsi/scsi_transport_fc.h>
32 #include <scsi/scsi_bsg_fc.h>
33 #include "ibmvfc.h"
34 
35 static unsigned int init_timeout = IBMVFC_INIT_TIMEOUT;
36 static unsigned int default_timeout = IBMVFC_DEFAULT_TIMEOUT;
37 static u64 max_lun = IBMVFC_MAX_LUN;
38 static unsigned int max_targets = IBMVFC_MAX_TARGETS;
39 static unsigned int max_requests = IBMVFC_MAX_REQUESTS_DEFAULT;
40 static unsigned int disc_threads = IBMVFC_MAX_DISC_THREADS;
41 static unsigned int ibmvfc_debug = IBMVFC_DEBUG;
42 static unsigned int log_level = IBMVFC_DEFAULT_LOG_LEVEL;
43 static unsigned int cls3_error = IBMVFC_CLS3_ERROR;
44 static unsigned int mq_enabled = IBMVFC_MQ;
45 static unsigned int nr_scsi_hw_queues = IBMVFC_SCSI_HW_QUEUES;
46 static unsigned int nr_scsi_channels = IBMVFC_SCSI_CHANNELS;
47 static unsigned int mig_channels_only = IBMVFC_MIG_NO_SUB_TO_CRQ;
48 static unsigned int mig_no_less_channels = IBMVFC_MIG_NO_N_TO_M;
49 
50 static LIST_HEAD(ibmvfc_head);
51 static DEFINE_SPINLOCK(ibmvfc_driver_lock);
52 static struct scsi_transport_template *ibmvfc_transport_template;
53 
54 MODULE_DESCRIPTION("IBM Virtual Fibre Channel Driver");
55 MODULE_AUTHOR("Brian King <brking@linux.vnet.ibm.com>");
56 MODULE_LICENSE("GPL");
57 MODULE_VERSION(IBMVFC_DRIVER_VERSION);
58 
59 module_param_named(mq, mq_enabled, uint, S_IRUGO);
60 MODULE_PARM_DESC(mq, "Enable multiqueue support. "
61 		 "[Default=" __stringify(IBMVFC_MQ) "]");
62 module_param_named(scsi_host_queues, nr_scsi_hw_queues, uint, S_IRUGO);
63 MODULE_PARM_DESC(scsi_host_queues, "Number of SCSI Host submission queues. "
64 		 "[Default=" __stringify(IBMVFC_SCSI_HW_QUEUES) "]");
65 module_param_named(scsi_hw_channels, nr_scsi_channels, uint, S_IRUGO);
66 MODULE_PARM_DESC(scsi_hw_channels, "Number of hw scsi channels to request. "
67 		 "[Default=" __stringify(IBMVFC_SCSI_CHANNELS) "]");
68 module_param_named(mig_channels_only, mig_channels_only, uint, S_IRUGO);
69 MODULE_PARM_DESC(mig_channels_only, "Prevent migration to non-channelized system. "
70 		 "[Default=" __stringify(IBMVFC_MIG_NO_SUB_TO_CRQ) "]");
71 module_param_named(mig_no_less_channels, mig_no_less_channels, uint, S_IRUGO);
72 MODULE_PARM_DESC(mig_no_less_channels, "Prevent migration to system with less channels. "
73 		 "[Default=" __stringify(IBMVFC_MIG_NO_N_TO_M) "]");
74 
75 module_param_named(init_timeout, init_timeout, uint, S_IRUGO | S_IWUSR);
76 MODULE_PARM_DESC(init_timeout, "Initialization timeout in seconds. "
77 		 "[Default=" __stringify(IBMVFC_INIT_TIMEOUT) "]");
78 module_param_named(default_timeout, default_timeout, uint, S_IRUGO | S_IWUSR);
79 MODULE_PARM_DESC(default_timeout,
80 		 "Default timeout in seconds for initialization and EH commands. "
81 		 "[Default=" __stringify(IBMVFC_DEFAULT_TIMEOUT) "]");
82 module_param_named(max_requests, max_requests, uint, S_IRUGO);
83 MODULE_PARM_DESC(max_requests, "Maximum requests for this adapter. "
84 		 "[Default=" __stringify(IBMVFC_MAX_REQUESTS_DEFAULT) "]");
85 module_param_named(max_lun, max_lun, ullong, S_IRUGO);
86 MODULE_PARM_DESC(max_lun, "Maximum allowed LUN. "
87 		 "[Default=" __stringify(IBMVFC_MAX_LUN) "]");
88 module_param_named(max_targets, max_targets, uint, S_IRUGO);
89 MODULE_PARM_DESC(max_targets, "Maximum allowed targets. "
90 		 "[Default=" __stringify(IBMVFC_MAX_TARGETS) "]");
91 module_param_named(disc_threads, disc_threads, uint, S_IRUGO);
92 MODULE_PARM_DESC(disc_threads, "Number of device discovery threads to use. "
93 		 "[Default=" __stringify(IBMVFC_MAX_DISC_THREADS) "]");
94 module_param_named(debug, ibmvfc_debug, uint, S_IRUGO | S_IWUSR);
95 MODULE_PARM_DESC(debug, "Enable driver debug information. "
96 		 "[Default=" __stringify(IBMVFC_DEBUG) "]");
97 module_param_named(log_level, log_level, uint, 0);
98 MODULE_PARM_DESC(log_level, "Set to 0 - 4 for increasing verbosity of device driver. "
99 		 "[Default=" __stringify(IBMVFC_DEFAULT_LOG_LEVEL) "]");
100 module_param_named(cls3_error, cls3_error, uint, 0);
101 MODULE_PARM_DESC(cls3_error, "Enable FC Class 3 Error Recovery. "
102 		 "[Default=" __stringify(IBMVFC_CLS3_ERROR) "]");
103 
104 static const struct {
105 	u16 status;
106 	u16 error;
107 	u8 result;
108 	u8 retry;
109 	int log;
110 	char *name;
111 } cmd_status [] = {
112 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_UNABLE_TO_ESTABLISH, DID_ERROR, 1, 1, "unable to establish" },
113 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_FAULT, DID_OK, 1, 0, "transport fault" },
114 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_CMD_TIMEOUT, DID_TIME_OUT, 1, 1, "command timeout" },
115 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_ENETDOWN, DID_TRANSPORT_DISRUPTED, 1, 1, "network down" },
116 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_HW_FAILURE, DID_ERROR, 1, 1, "hardware failure" },
117 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_LINK_DOWN_ERR, DID_REQUEUE, 0, 0, "link down" },
118 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_LINK_DEAD_ERR, DID_ERROR, 0, 0, "link dead" },
119 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_UNABLE_TO_REGISTER, DID_ERROR, 1, 1, "unable to register" },
120 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_BUSY, DID_BUS_BUSY, 1, 0, "transport busy" },
121 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_DEAD, DID_ERROR, 0, 1, "transport dead" },
122 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_CONFIG_ERROR, DID_ERROR, 1, 1, "configuration error" },
123 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_NAME_SERVER_FAIL, DID_ERROR, 1, 1, "name server failure" },
124 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_LINK_HALTED, DID_REQUEUE, 1, 0, "link halted" },
125 	{ IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_GENERAL, DID_OK, 1, 0, "general transport error" },
126 
127 	{ IBMVFC_VIOS_FAILURE, IBMVFC_CRQ_FAILURE, DID_REQUEUE, 1, 1, "CRQ failure" },
128 	{ IBMVFC_VIOS_FAILURE, IBMVFC_SW_FAILURE, DID_ERROR, 0, 1, "software failure" },
129 	{ IBMVFC_VIOS_FAILURE, IBMVFC_INVALID_PARAMETER, DID_ERROR, 0, 1, "invalid parameter" },
130 	{ IBMVFC_VIOS_FAILURE, IBMVFC_MISSING_PARAMETER, DID_ERROR, 0, 1, "missing parameter" },
131 	{ IBMVFC_VIOS_FAILURE, IBMVFC_HOST_IO_BUS, DID_ERROR, 1, 1, "host I/O bus failure" },
132 	{ IBMVFC_VIOS_FAILURE, IBMVFC_TRANS_CANCELLED, DID_ERROR, 0, 1, "transaction cancelled" },
133 	{ IBMVFC_VIOS_FAILURE, IBMVFC_TRANS_CANCELLED_IMPLICIT, DID_ERROR, 0, 1, "transaction cancelled implicit" },
134 	{ IBMVFC_VIOS_FAILURE, IBMVFC_INSUFFICIENT_RESOURCE, DID_REQUEUE, 1, 1, "insufficient resources" },
135 	{ IBMVFC_VIOS_FAILURE, IBMVFC_PLOGI_REQUIRED, DID_ERROR, 0, 1, "port login required" },
136 	{ IBMVFC_VIOS_FAILURE, IBMVFC_COMMAND_FAILED, DID_ERROR, 1, 1, "command failed" },
137 
138 	{ IBMVFC_FC_FAILURE, IBMVFC_INVALID_ELS_CMD_CODE, DID_ERROR, 0, 1, "invalid ELS command code" },
139 	{ IBMVFC_FC_FAILURE, IBMVFC_INVALID_VERSION, DID_ERROR, 0, 1, "invalid version level" },
140 	{ IBMVFC_FC_FAILURE, IBMVFC_LOGICAL_ERROR, DID_ERROR, 1, 1, "logical error" },
141 	{ IBMVFC_FC_FAILURE, IBMVFC_INVALID_CT_IU_SIZE, DID_ERROR, 0, 1, "invalid CT_IU size" },
142 	{ IBMVFC_FC_FAILURE, IBMVFC_LOGICAL_BUSY, DID_REQUEUE, 1, 0, "logical busy" },
143 	{ IBMVFC_FC_FAILURE, IBMVFC_PROTOCOL_ERROR, DID_ERROR, 1, 1, "protocol error" },
144 	{ IBMVFC_FC_FAILURE, IBMVFC_UNABLE_TO_PERFORM_REQ, DID_ERROR, 1, 1, "unable to perform request" },
145 	{ IBMVFC_FC_FAILURE, IBMVFC_CMD_NOT_SUPPORTED, DID_ERROR, 0, 0, "command not supported" },
146 	{ IBMVFC_FC_FAILURE, IBMVFC_SERVER_NOT_AVAIL, DID_ERROR, 0, 1, "server not available" },
147 	{ IBMVFC_FC_FAILURE, IBMVFC_CMD_IN_PROGRESS, DID_ERROR, 0, 1, "command already in progress" },
148 	{ IBMVFC_FC_FAILURE, IBMVFC_VENDOR_SPECIFIC, DID_ERROR, 1, 1, "vendor specific" },
149 
150 	{ IBMVFC_FC_SCSI_ERROR, 0, DID_OK, 1, 0, "SCSI error" },
151 	{ IBMVFC_FC_SCSI_ERROR, IBMVFC_COMMAND_FAILED, DID_ERROR, 0, 1, "PRLI to device failed." },
152 };
153 
154 static void ibmvfc_npiv_login(struct ibmvfc_host *);
155 static void ibmvfc_tgt_send_prli(struct ibmvfc_target *);
156 static void ibmvfc_tgt_send_plogi(struct ibmvfc_target *);
157 static void ibmvfc_tgt_query_target(struct ibmvfc_target *);
158 static void ibmvfc_npiv_logout(struct ibmvfc_host *);
159 static void ibmvfc_tgt_implicit_logout_and_del(struct ibmvfc_target *);
160 static void ibmvfc_tgt_move_login(struct ibmvfc_target *);
161 
162 static void ibmvfc_release_sub_crqs(struct ibmvfc_host *);
163 static void ibmvfc_init_sub_crqs(struct ibmvfc_host *);
164 
165 static const char *unknown_error = "unknown error";
166 
167 static long h_reg_sub_crq(unsigned long unit_address, unsigned long ioba,
168 			  unsigned long length, unsigned long *cookie,
169 			  unsigned long *irq)
170 {
171 	unsigned long retbuf[PLPAR_HCALL_BUFSIZE];
172 	long rc;
173 
174 	rc = plpar_hcall(H_REG_SUB_CRQ, retbuf, unit_address, ioba, length);
175 	*cookie = retbuf[0];
176 	*irq = retbuf[1];
177 
178 	return rc;
179 }
180 
181 static int ibmvfc_check_caps(struct ibmvfc_host *vhost, unsigned long cap_flags)
182 {
183 	u64 host_caps = be64_to_cpu(vhost->login_buf->resp.capabilities);
184 
185 	return (host_caps & cap_flags) ? 1 : 0;
186 }
187 
188 static struct ibmvfc_fcp_cmd_iu *ibmvfc_get_fcp_iu(struct ibmvfc_host *vhost,
189 						   struct ibmvfc_cmd *vfc_cmd)
190 {
191 	if (ibmvfc_check_caps(vhost, IBMVFC_HANDLE_VF_WWPN))
192 		return &vfc_cmd->v2.iu;
193 	else
194 		return &vfc_cmd->v1.iu;
195 }
196 
197 static struct ibmvfc_fcp_rsp *ibmvfc_get_fcp_rsp(struct ibmvfc_host *vhost,
198 						 struct ibmvfc_cmd *vfc_cmd)
199 {
200 	if (ibmvfc_check_caps(vhost, IBMVFC_HANDLE_VF_WWPN))
201 		return &vfc_cmd->v2.rsp;
202 	else
203 		return &vfc_cmd->v1.rsp;
204 }
205 
206 #ifdef CONFIG_SCSI_IBMVFC_TRACE
207 /**
208  * ibmvfc_trc_start - Log a start trace entry
209  * @evt:		ibmvfc event struct
210  *
211  **/
212 static void ibmvfc_trc_start(struct ibmvfc_event *evt)
213 {
214 	struct ibmvfc_host *vhost = evt->vhost;
215 	struct ibmvfc_cmd *vfc_cmd = &evt->iu.cmd;
216 	struct ibmvfc_mad_common *mad = &evt->iu.mad_common;
217 	struct ibmvfc_fcp_cmd_iu *iu = ibmvfc_get_fcp_iu(vhost, vfc_cmd);
218 	struct ibmvfc_trace_entry *entry;
219 	int index = atomic_inc_return(&vhost->trace_index) & IBMVFC_TRACE_INDEX_MASK;
220 
221 	entry = &vhost->trace[index];
222 	entry->evt = evt;
223 	entry->time = jiffies;
224 	entry->fmt = evt->crq.format;
225 	entry->type = IBMVFC_TRC_START;
226 
227 	switch (entry->fmt) {
228 	case IBMVFC_CMD_FORMAT:
229 		entry->op_code = iu->cdb[0];
230 		entry->scsi_id = be64_to_cpu(vfc_cmd->tgt_scsi_id);
231 		entry->lun = scsilun_to_int(&iu->lun);
232 		entry->tmf_flags = iu->tmf_flags;
233 		entry->u.start.xfer_len = be32_to_cpu(iu->xfer_len);
234 		break;
235 	case IBMVFC_MAD_FORMAT:
236 		entry->op_code = be32_to_cpu(mad->opcode);
237 		break;
238 	default:
239 		break;
240 	}
241 }
242 
243 /**
244  * ibmvfc_trc_end - Log an end trace entry
245  * @evt:		ibmvfc event struct
246  *
247  **/
248 static void ibmvfc_trc_end(struct ibmvfc_event *evt)
249 {
250 	struct ibmvfc_host *vhost = evt->vhost;
251 	struct ibmvfc_cmd *vfc_cmd = &evt->xfer_iu->cmd;
252 	struct ibmvfc_mad_common *mad = &evt->xfer_iu->mad_common;
253 	struct ibmvfc_fcp_cmd_iu *iu = ibmvfc_get_fcp_iu(vhost, vfc_cmd);
254 	struct ibmvfc_fcp_rsp *rsp = ibmvfc_get_fcp_rsp(vhost, vfc_cmd);
255 	struct ibmvfc_trace_entry *entry;
256 	int index = atomic_inc_return(&vhost->trace_index) & IBMVFC_TRACE_INDEX_MASK;
257 
258 	entry = &vhost->trace[index];
259 	entry->evt = evt;
260 	entry->time = jiffies;
261 	entry->fmt = evt->crq.format;
262 	entry->type = IBMVFC_TRC_END;
263 
264 	switch (entry->fmt) {
265 	case IBMVFC_CMD_FORMAT:
266 		entry->op_code = iu->cdb[0];
267 		entry->scsi_id = be64_to_cpu(vfc_cmd->tgt_scsi_id);
268 		entry->lun = scsilun_to_int(&iu->lun);
269 		entry->tmf_flags = iu->tmf_flags;
270 		entry->u.end.status = be16_to_cpu(vfc_cmd->status);
271 		entry->u.end.error = be16_to_cpu(vfc_cmd->error);
272 		entry->u.end.fcp_rsp_flags = rsp->flags;
273 		entry->u.end.rsp_code = rsp->data.info.rsp_code;
274 		entry->u.end.scsi_status = rsp->scsi_status;
275 		break;
276 	case IBMVFC_MAD_FORMAT:
277 		entry->op_code = be32_to_cpu(mad->opcode);
278 		entry->u.end.status = be16_to_cpu(mad->status);
279 		break;
280 	default:
281 		break;
282 
283 	}
284 }
285 
286 #else
287 #define ibmvfc_trc_start(evt) do { } while (0)
288 #define ibmvfc_trc_end(evt) do { } while (0)
289 #endif
290 
291 /**
292  * ibmvfc_get_err_index - Find the index into cmd_status for the fcp response
293  * @status:		status / error class
294  * @error:		error
295  *
296  * Return value:
297  *	index into cmd_status / -EINVAL on failure
298  **/
299 static int ibmvfc_get_err_index(u16 status, u16 error)
300 {
301 	int i;
302 
303 	for (i = 0; i < ARRAY_SIZE(cmd_status); i++)
304 		if ((cmd_status[i].status & status) == cmd_status[i].status &&
305 		    cmd_status[i].error == error)
306 			return i;
307 
308 	return -EINVAL;
309 }
310 
311 /**
312  * ibmvfc_get_cmd_error - Find the error description for the fcp response
313  * @status:		status / error class
314  * @error:		error
315  *
316  * Return value:
317  *	error description string
318  **/
319 static const char *ibmvfc_get_cmd_error(u16 status, u16 error)
320 {
321 	int rc = ibmvfc_get_err_index(status, error);
322 	if (rc >= 0)
323 		return cmd_status[rc].name;
324 	return unknown_error;
325 }
326 
327 /**
328  * ibmvfc_get_err_result - Find the scsi status to return for the fcp response
329  * @vfc_cmd:	ibmvfc command struct
330  *
331  * Return value:
332  *	SCSI result value to return for completed command
333  **/
334 static int ibmvfc_get_err_result(struct ibmvfc_host *vhost, struct ibmvfc_cmd *vfc_cmd)
335 {
336 	int err;
337 	struct ibmvfc_fcp_rsp *rsp = ibmvfc_get_fcp_rsp(vhost, vfc_cmd);
338 	int fc_rsp_len = be32_to_cpu(rsp->fcp_rsp_len);
339 
340 	if ((rsp->flags & FCP_RSP_LEN_VALID) &&
341 	    ((fc_rsp_len && fc_rsp_len != 4 && fc_rsp_len != 8) ||
342 	     rsp->data.info.rsp_code))
343 		return DID_ERROR << 16;
344 
345 	err = ibmvfc_get_err_index(be16_to_cpu(vfc_cmd->status), be16_to_cpu(vfc_cmd->error));
346 	if (err >= 0)
347 		return rsp->scsi_status | (cmd_status[err].result << 16);
348 	return rsp->scsi_status | (DID_ERROR << 16);
349 }
350 
351 /**
352  * ibmvfc_retry_cmd - Determine if error status is retryable
353  * @status:		status / error class
354  * @error:		error
355  *
356  * Return value:
357  *	1 if error should be retried / 0 if it should not
358  **/
359 static int ibmvfc_retry_cmd(u16 status, u16 error)
360 {
361 	int rc = ibmvfc_get_err_index(status, error);
362 
363 	if (rc >= 0)
364 		return cmd_status[rc].retry;
365 	return 1;
366 }
367 
368 static const char *unknown_fc_explain = "unknown fc explain";
369 
370 static const struct {
371 	u16 fc_explain;
372 	char *name;
373 } ls_explain [] = {
374 	{ 0x00, "no additional explanation" },
375 	{ 0x01, "service parameter error - options" },
376 	{ 0x03, "service parameter error - initiator control" },
377 	{ 0x05, "service parameter error - recipient control" },
378 	{ 0x07, "service parameter error - received data field size" },
379 	{ 0x09, "service parameter error - concurrent seq" },
380 	{ 0x0B, "service parameter error - credit" },
381 	{ 0x0D, "invalid N_Port/F_Port_Name" },
382 	{ 0x0E, "invalid node/Fabric Name" },
383 	{ 0x0F, "invalid common service parameters" },
384 	{ 0x11, "invalid association header" },
385 	{ 0x13, "association header required" },
386 	{ 0x15, "invalid originator S_ID" },
387 	{ 0x17, "invalid OX_ID-RX-ID combination" },
388 	{ 0x19, "command (request) already in progress" },
389 	{ 0x1E, "N_Port Login requested" },
390 	{ 0x1F, "Invalid N_Port_ID" },
391 };
392 
393 static const struct {
394 	u16 fc_explain;
395 	char *name;
396 } gs_explain [] = {
397 	{ 0x00, "no additional explanation" },
398 	{ 0x01, "port identifier not registered" },
399 	{ 0x02, "port name not registered" },
400 	{ 0x03, "node name not registered" },
401 	{ 0x04, "class of service not registered" },
402 	{ 0x06, "initial process associator not registered" },
403 	{ 0x07, "FC-4 TYPEs not registered" },
404 	{ 0x08, "symbolic port name not registered" },
405 	{ 0x09, "symbolic node name not registered" },
406 	{ 0x0A, "port type not registered" },
407 	{ 0xF0, "authorization exception" },
408 	{ 0xF1, "authentication exception" },
409 	{ 0xF2, "data base full" },
410 	{ 0xF3, "data base empty" },
411 	{ 0xF4, "processing request" },
412 	{ 0xF5, "unable to verify connection" },
413 	{ 0xF6, "devices not in a common zone" },
414 };
415 
416 /**
417  * ibmvfc_get_ls_explain - Return the FC Explain description text
418  * @status:	FC Explain status
419  *
420  * Returns:
421  *	error string
422  **/
423 static const char *ibmvfc_get_ls_explain(u16 status)
424 {
425 	int i;
426 
427 	for (i = 0; i < ARRAY_SIZE(ls_explain); i++)
428 		if (ls_explain[i].fc_explain == status)
429 			return ls_explain[i].name;
430 
431 	return unknown_fc_explain;
432 }
433 
434 /**
435  * ibmvfc_get_gs_explain - Return the FC Explain description text
436  * @status:	FC Explain status
437  *
438  * Returns:
439  *	error string
440  **/
441 static const char *ibmvfc_get_gs_explain(u16 status)
442 {
443 	int i;
444 
445 	for (i = 0; i < ARRAY_SIZE(gs_explain); i++)
446 		if (gs_explain[i].fc_explain == status)
447 			return gs_explain[i].name;
448 
449 	return unknown_fc_explain;
450 }
451 
452 static const struct {
453 	enum ibmvfc_fc_type fc_type;
454 	char *name;
455 } fc_type [] = {
456 	{ IBMVFC_FABRIC_REJECT, "fabric reject" },
457 	{ IBMVFC_PORT_REJECT, "port reject" },
458 	{ IBMVFC_LS_REJECT, "ELS reject" },
459 	{ IBMVFC_FABRIC_BUSY, "fabric busy" },
460 	{ IBMVFC_PORT_BUSY, "port busy" },
461 	{ IBMVFC_BASIC_REJECT, "basic reject" },
462 };
463 
464 static const char *unknown_fc_type = "unknown fc type";
465 
466 /**
467  * ibmvfc_get_fc_type - Return the FC Type description text
468  * @status:	FC Type error status
469  *
470  * Returns:
471  *	error string
472  **/
473 static const char *ibmvfc_get_fc_type(u16 status)
474 {
475 	int i;
476 
477 	for (i = 0; i < ARRAY_SIZE(fc_type); i++)
478 		if (fc_type[i].fc_type == status)
479 			return fc_type[i].name;
480 
481 	return unknown_fc_type;
482 }
483 
484 /**
485  * ibmvfc_set_tgt_action - Set the next init action for the target
486  * @tgt:		ibmvfc target struct
487  * @action:		action to perform
488  *
489  * Returns:
490  *	0 if action changed / non-zero if not changed
491  **/
492 static int ibmvfc_set_tgt_action(struct ibmvfc_target *tgt,
493 				  enum ibmvfc_target_action action)
494 {
495 	int rc = -EINVAL;
496 
497 	switch (tgt->action) {
498 	case IBMVFC_TGT_ACTION_LOGOUT_RPORT:
499 		if (action == IBMVFC_TGT_ACTION_LOGOUT_RPORT_WAIT ||
500 		    action == IBMVFC_TGT_ACTION_DEL_RPORT) {
501 			tgt->action = action;
502 			rc = 0;
503 		}
504 		break;
505 	case IBMVFC_TGT_ACTION_LOGOUT_RPORT_WAIT:
506 		if (action == IBMVFC_TGT_ACTION_DEL_RPORT ||
507 		    action == IBMVFC_TGT_ACTION_DEL_AND_LOGOUT_RPORT) {
508 			tgt->action = action;
509 			rc = 0;
510 		}
511 		break;
512 	case IBMVFC_TGT_ACTION_LOGOUT_DELETED_RPORT:
513 		if (action == IBMVFC_TGT_ACTION_LOGOUT_RPORT) {
514 			tgt->action = action;
515 			rc = 0;
516 		}
517 		break;
518 	case IBMVFC_TGT_ACTION_DEL_AND_LOGOUT_RPORT:
519 		if (action == IBMVFC_TGT_ACTION_LOGOUT_DELETED_RPORT) {
520 			tgt->action = action;
521 			rc = 0;
522 		}
523 		break;
524 	case IBMVFC_TGT_ACTION_DEL_RPORT:
525 		if (action == IBMVFC_TGT_ACTION_DELETED_RPORT) {
526 			tgt->action = action;
527 			rc = 0;
528 		}
529 		break;
530 	case IBMVFC_TGT_ACTION_DELETED_RPORT:
531 		break;
532 	default:
533 		tgt->action = action;
534 		rc = 0;
535 		break;
536 	}
537 
538 	if (action >= IBMVFC_TGT_ACTION_LOGOUT_RPORT)
539 		tgt->add_rport = 0;
540 
541 	return rc;
542 }
543 
544 /**
545  * ibmvfc_set_host_state - Set the state for the host
546  * @vhost:		ibmvfc host struct
547  * @state:		state to set host to
548  *
549  * Returns:
550  *	0 if state changed / non-zero if not changed
551  **/
552 static int ibmvfc_set_host_state(struct ibmvfc_host *vhost,
553 				  enum ibmvfc_host_state state)
554 {
555 	int rc = 0;
556 
557 	switch (vhost->state) {
558 	case IBMVFC_HOST_OFFLINE:
559 		rc = -EINVAL;
560 		break;
561 	default:
562 		vhost->state = state;
563 		break;
564 	}
565 
566 	return rc;
567 }
568 
569 /**
570  * ibmvfc_set_host_action - Set the next init action for the host
571  * @vhost:		ibmvfc host struct
572  * @action:		action to perform
573  *
574  **/
575 static void ibmvfc_set_host_action(struct ibmvfc_host *vhost,
576 				   enum ibmvfc_host_action action)
577 {
578 	switch (action) {
579 	case IBMVFC_HOST_ACTION_ALLOC_TGTS:
580 		if (vhost->action == IBMVFC_HOST_ACTION_INIT_WAIT)
581 			vhost->action = action;
582 		break;
583 	case IBMVFC_HOST_ACTION_LOGO_WAIT:
584 		if (vhost->action == IBMVFC_HOST_ACTION_LOGO)
585 			vhost->action = action;
586 		break;
587 	case IBMVFC_HOST_ACTION_INIT_WAIT:
588 		if (vhost->action == IBMVFC_HOST_ACTION_INIT)
589 			vhost->action = action;
590 		break;
591 	case IBMVFC_HOST_ACTION_QUERY:
592 		switch (vhost->action) {
593 		case IBMVFC_HOST_ACTION_INIT_WAIT:
594 		case IBMVFC_HOST_ACTION_NONE:
595 		case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
596 			vhost->action = action;
597 			break;
598 		default:
599 			break;
600 		}
601 		break;
602 	case IBMVFC_HOST_ACTION_TGT_INIT:
603 		if (vhost->action == IBMVFC_HOST_ACTION_ALLOC_TGTS)
604 			vhost->action = action;
605 		break;
606 	case IBMVFC_HOST_ACTION_INIT:
607 	case IBMVFC_HOST_ACTION_TGT_DEL:
608 		switch (vhost->action) {
609 		case IBMVFC_HOST_ACTION_RESET:
610 		case IBMVFC_HOST_ACTION_REENABLE:
611 			break;
612 		default:
613 			vhost->action = action;
614 			break;
615 		}
616 		break;
617 	case IBMVFC_HOST_ACTION_LOGO:
618 	case IBMVFC_HOST_ACTION_QUERY_TGTS:
619 	case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
620 	case IBMVFC_HOST_ACTION_NONE:
621 	case IBMVFC_HOST_ACTION_RESET:
622 	case IBMVFC_HOST_ACTION_REENABLE:
623 	default:
624 		vhost->action = action;
625 		break;
626 	}
627 }
628 
629 /**
630  * ibmvfc_reinit_host - Re-start host initialization (no NPIV Login)
631  * @vhost:		ibmvfc host struct
632  *
633  * Return value:
634  *	nothing
635  **/
636 static void ibmvfc_reinit_host(struct ibmvfc_host *vhost)
637 {
638 	if (vhost->action == IBMVFC_HOST_ACTION_NONE &&
639 	    vhost->state == IBMVFC_ACTIVE) {
640 		if (!ibmvfc_set_host_state(vhost, IBMVFC_INITIALIZING)) {
641 			scsi_block_requests(vhost->host);
642 			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY);
643 		}
644 	} else
645 		vhost->reinit = 1;
646 
647 	wake_up(&vhost->work_wait_q);
648 }
649 
650 /**
651  * ibmvfc_del_tgt - Schedule cleanup and removal of the target
652  * @tgt:		ibmvfc target struct
653  * @job_step:	job step to perform
654  *
655  **/
656 static void ibmvfc_del_tgt(struct ibmvfc_target *tgt)
657 {
658 	if (!ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_LOGOUT_RPORT))
659 		tgt->job_step = ibmvfc_tgt_implicit_logout_and_del;
660 	wake_up(&tgt->vhost->work_wait_q);
661 }
662 
663 /**
664  * ibmvfc_link_down - Handle a link down event from the adapter
665  * @vhost:	ibmvfc host struct
666  * @state:	ibmvfc host state to enter
667  *
668  **/
669 static void ibmvfc_link_down(struct ibmvfc_host *vhost,
670 			     enum ibmvfc_host_state state)
671 {
672 	struct ibmvfc_target *tgt;
673 
674 	ENTER;
675 	scsi_block_requests(vhost->host);
676 	list_for_each_entry(tgt, &vhost->targets, queue)
677 		ibmvfc_del_tgt(tgt);
678 	ibmvfc_set_host_state(vhost, state);
679 	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_DEL);
680 	vhost->events_to_log |= IBMVFC_AE_LINKDOWN;
681 	wake_up(&vhost->work_wait_q);
682 	LEAVE;
683 }
684 
685 /**
686  * ibmvfc_init_host - Start host initialization
687  * @vhost:		ibmvfc host struct
688  *
689  * Return value:
690  *	nothing
691  **/
692 static void ibmvfc_init_host(struct ibmvfc_host *vhost)
693 {
694 	struct ibmvfc_target *tgt;
695 
696 	if (vhost->action == IBMVFC_HOST_ACTION_INIT_WAIT) {
697 		if (++vhost->init_retries > IBMVFC_MAX_HOST_INIT_RETRIES) {
698 			dev_err(vhost->dev,
699 				"Host initialization retries exceeded. Taking adapter offline\n");
700 			ibmvfc_link_down(vhost, IBMVFC_HOST_OFFLINE);
701 			return;
702 		}
703 	}
704 
705 	if (!ibmvfc_set_host_state(vhost, IBMVFC_INITIALIZING)) {
706 		memset(vhost->async_crq.msgs.async, 0, PAGE_SIZE);
707 		vhost->async_crq.cur = 0;
708 
709 		list_for_each_entry(tgt, &vhost->targets, queue)
710 			ibmvfc_del_tgt(tgt);
711 		scsi_block_requests(vhost->host);
712 		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT);
713 		vhost->job_step = ibmvfc_npiv_login;
714 		wake_up(&vhost->work_wait_q);
715 	}
716 }
717 
718 /**
719  * ibmvfc_send_crq - Send a CRQ
720  * @vhost:	ibmvfc host struct
721  * @word1:	the first 64 bits of the data
722  * @word2:	the second 64 bits of the data
723  *
724  * Return value:
725  *	0 on success / other on failure
726  **/
727 static int ibmvfc_send_crq(struct ibmvfc_host *vhost, u64 word1, u64 word2)
728 {
729 	struct vio_dev *vdev = to_vio_dev(vhost->dev);
730 	return plpar_hcall_norets(H_SEND_CRQ, vdev->unit_address, word1, word2);
731 }
732 
733 static int ibmvfc_send_sub_crq(struct ibmvfc_host *vhost, u64 cookie, u64 word1,
734 			       u64 word2, u64 word3, u64 word4)
735 {
736 	struct vio_dev *vdev = to_vio_dev(vhost->dev);
737 
738 	return plpar_hcall_norets(H_SEND_SUB_CRQ, vdev->unit_address, cookie,
739 				  word1, word2, word3, word4);
740 }
741 
742 /**
743  * ibmvfc_send_crq_init - Send a CRQ init message
744  * @vhost:	ibmvfc host struct
745  *
746  * Return value:
747  *	0 on success / other on failure
748  **/
749 static int ibmvfc_send_crq_init(struct ibmvfc_host *vhost)
750 {
751 	ibmvfc_dbg(vhost, "Sending CRQ init\n");
752 	return ibmvfc_send_crq(vhost, 0xC001000000000000LL, 0);
753 }
754 
755 /**
756  * ibmvfc_send_crq_init_complete - Send a CRQ init complete message
757  * @vhost:	ibmvfc host struct
758  *
759  * Return value:
760  *	0 on success / other on failure
761  **/
762 static int ibmvfc_send_crq_init_complete(struct ibmvfc_host *vhost)
763 {
764 	ibmvfc_dbg(vhost, "Sending CRQ init complete\n");
765 	return ibmvfc_send_crq(vhost, 0xC002000000000000LL, 0);
766 }
767 
768 /**
769  * ibmvfc_init_event_pool - Allocates and initializes the event pool for a host
770  * @vhost:	ibmvfc host who owns the event pool
771  *
772  * Returns zero on success.
773  **/
774 static int ibmvfc_init_event_pool(struct ibmvfc_host *vhost,
775 				  struct ibmvfc_queue *queue,
776 				  unsigned int size)
777 {
778 	int i;
779 	struct ibmvfc_event_pool *pool = &queue->evt_pool;
780 
781 	ENTER;
782 	if (!size)
783 		return 0;
784 
785 	pool->size = size;
786 	pool->events = kcalloc(size, sizeof(*pool->events), GFP_KERNEL);
787 	if (!pool->events)
788 		return -ENOMEM;
789 
790 	pool->iu_storage = dma_alloc_coherent(vhost->dev,
791 					      size * sizeof(*pool->iu_storage),
792 					      &pool->iu_token, 0);
793 
794 	if (!pool->iu_storage) {
795 		kfree(pool->events);
796 		return -ENOMEM;
797 	}
798 
799 	INIT_LIST_HEAD(&queue->sent);
800 	INIT_LIST_HEAD(&queue->free);
801 	spin_lock_init(&queue->l_lock);
802 
803 	for (i = 0; i < size; ++i) {
804 		struct ibmvfc_event *evt = &pool->events[i];
805 
806 		atomic_set(&evt->free, 1);
807 		evt->crq.valid = 0x80;
808 		evt->crq.ioba = cpu_to_be64(pool->iu_token + (sizeof(*evt->xfer_iu) * i));
809 		evt->xfer_iu = pool->iu_storage + i;
810 		evt->vhost = vhost;
811 		evt->queue = queue;
812 		evt->ext_list = NULL;
813 		list_add_tail(&evt->queue_list, &queue->free);
814 	}
815 
816 	LEAVE;
817 	return 0;
818 }
819 
820 /**
821  * ibmvfc_free_event_pool - Frees memory of the event pool of a host
822  * @vhost:	ibmvfc host who owns the event pool
823  *
824  **/
825 static void ibmvfc_free_event_pool(struct ibmvfc_host *vhost,
826 				   struct ibmvfc_queue *queue)
827 {
828 	int i;
829 	struct ibmvfc_event_pool *pool = &queue->evt_pool;
830 
831 	ENTER;
832 	for (i = 0; i < pool->size; ++i) {
833 		list_del(&pool->events[i].queue_list);
834 		BUG_ON(atomic_read(&pool->events[i].free) != 1);
835 		if (pool->events[i].ext_list)
836 			dma_pool_free(vhost->sg_pool,
837 				      pool->events[i].ext_list,
838 				      pool->events[i].ext_list_token);
839 	}
840 
841 	kfree(pool->events);
842 	dma_free_coherent(vhost->dev,
843 			  pool->size * sizeof(*pool->iu_storage),
844 			  pool->iu_storage, pool->iu_token);
845 	LEAVE;
846 }
847 
848 /**
849  * ibmvfc_free_queue - Deallocate queue
850  * @vhost:	ibmvfc host struct
851  * @queue:	ibmvfc queue struct
852  *
853  * Unmaps dma and deallocates page for messages
854  **/
855 static void ibmvfc_free_queue(struct ibmvfc_host *vhost,
856 			      struct ibmvfc_queue *queue)
857 {
858 	struct device *dev = vhost->dev;
859 
860 	dma_unmap_single(dev, queue->msg_token, PAGE_SIZE, DMA_BIDIRECTIONAL);
861 	free_page((unsigned long)queue->msgs.handle);
862 	queue->msgs.handle = NULL;
863 
864 	ibmvfc_free_event_pool(vhost, queue);
865 }
866 
867 /**
868  * ibmvfc_release_crq_queue - Deallocates data and unregisters CRQ
869  * @vhost:	ibmvfc host struct
870  *
871  * Frees irq, deallocates a page for messages, unmaps dma, and unregisters
872  * the crq with the hypervisor.
873  **/
874 static void ibmvfc_release_crq_queue(struct ibmvfc_host *vhost)
875 {
876 	long rc = 0;
877 	struct vio_dev *vdev = to_vio_dev(vhost->dev);
878 	struct ibmvfc_queue *crq = &vhost->crq;
879 
880 	ibmvfc_dbg(vhost, "Releasing CRQ\n");
881 	free_irq(vdev->irq, vhost);
882 	tasklet_kill(&vhost->tasklet);
883 	do {
884 		if (rc)
885 			msleep(100);
886 		rc = plpar_hcall_norets(H_FREE_CRQ, vdev->unit_address);
887 	} while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
888 
889 	vhost->state = IBMVFC_NO_CRQ;
890 	vhost->logged_in = 0;
891 
892 	ibmvfc_free_queue(vhost, crq);
893 }
894 
895 /**
896  * ibmvfc_reenable_crq_queue - reenables the CRQ
897  * @vhost:	ibmvfc host struct
898  *
899  * Return value:
900  *	0 on success / other on failure
901  **/
902 static int ibmvfc_reenable_crq_queue(struct ibmvfc_host *vhost)
903 {
904 	int rc = 0;
905 	struct vio_dev *vdev = to_vio_dev(vhost->dev);
906 	unsigned long flags;
907 
908 	ibmvfc_release_sub_crqs(vhost);
909 
910 	/* Re-enable the CRQ */
911 	do {
912 		if (rc)
913 			msleep(100);
914 		rc = plpar_hcall_norets(H_ENABLE_CRQ, vdev->unit_address);
915 	} while (rc == H_IN_PROGRESS || rc == H_BUSY || H_IS_LONG_BUSY(rc));
916 
917 	if (rc)
918 		dev_err(vhost->dev, "Error enabling adapter (rc=%d)\n", rc);
919 
920 	spin_lock_irqsave(vhost->host->host_lock, flags);
921 	spin_lock(vhost->crq.q_lock);
922 	vhost->do_enquiry = 1;
923 	vhost->using_channels = 0;
924 	spin_unlock(vhost->crq.q_lock);
925 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
926 
927 	ibmvfc_init_sub_crqs(vhost);
928 
929 	return rc;
930 }
931 
932 /**
933  * ibmvfc_reset_crq - resets a crq after a failure
934  * @vhost:	ibmvfc host struct
935  *
936  * Return value:
937  *	0 on success / other on failure
938  **/
939 static int ibmvfc_reset_crq(struct ibmvfc_host *vhost)
940 {
941 	int rc = 0;
942 	unsigned long flags;
943 	struct vio_dev *vdev = to_vio_dev(vhost->dev);
944 	struct ibmvfc_queue *crq = &vhost->crq;
945 
946 	ibmvfc_release_sub_crqs(vhost);
947 
948 	/* Close the CRQ */
949 	do {
950 		if (rc)
951 			msleep(100);
952 		rc = plpar_hcall_norets(H_FREE_CRQ, vdev->unit_address);
953 	} while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
954 
955 	spin_lock_irqsave(vhost->host->host_lock, flags);
956 	spin_lock(vhost->crq.q_lock);
957 	vhost->state = IBMVFC_NO_CRQ;
958 	vhost->logged_in = 0;
959 	vhost->do_enquiry = 1;
960 	vhost->using_channels = 0;
961 
962 	/* Clean out the queue */
963 	memset(crq->msgs.crq, 0, PAGE_SIZE);
964 	crq->cur = 0;
965 
966 	/* And re-open it again */
967 	rc = plpar_hcall_norets(H_REG_CRQ, vdev->unit_address,
968 				crq->msg_token, PAGE_SIZE);
969 
970 	if (rc == H_CLOSED)
971 		/* Adapter is good, but other end is not ready */
972 		dev_warn(vhost->dev, "Partner adapter not ready\n");
973 	else if (rc != 0)
974 		dev_warn(vhost->dev, "Couldn't register crq (rc=%d)\n", rc);
975 
976 	spin_unlock(vhost->crq.q_lock);
977 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
978 
979 	ibmvfc_init_sub_crqs(vhost);
980 
981 	return rc;
982 }
983 
984 /**
985  * ibmvfc_valid_event - Determines if event is valid.
986  * @pool:	event_pool that contains the event
987  * @evt:	ibmvfc event to be checked for validity
988  *
989  * Return value:
990  *	1 if event is valid / 0 if event is not valid
991  **/
992 static int ibmvfc_valid_event(struct ibmvfc_event_pool *pool,
993 			      struct ibmvfc_event *evt)
994 {
995 	int index = evt - pool->events;
996 	if (index < 0 || index >= pool->size)	/* outside of bounds */
997 		return 0;
998 	if (evt != pool->events + index)	/* unaligned */
999 		return 0;
1000 	return 1;
1001 }
1002 
1003 /**
1004  * ibmvfc_free_event - Free the specified event
1005  * @evt:	ibmvfc_event to be freed
1006  *
1007  **/
1008 static void ibmvfc_free_event(struct ibmvfc_event *evt)
1009 {
1010 	struct ibmvfc_event_pool *pool = &evt->queue->evt_pool;
1011 	unsigned long flags;
1012 
1013 	BUG_ON(!ibmvfc_valid_event(pool, evt));
1014 	BUG_ON(atomic_inc_return(&evt->free) != 1);
1015 
1016 	spin_lock_irqsave(&evt->queue->l_lock, flags);
1017 	list_add_tail(&evt->queue_list, &evt->queue->free);
1018 	if (evt->eh_comp)
1019 		complete(evt->eh_comp);
1020 	spin_unlock_irqrestore(&evt->queue->l_lock, flags);
1021 }
1022 
1023 /**
1024  * ibmvfc_scsi_eh_done - EH done function for queuecommand commands
1025  * @evt:	ibmvfc event struct
1026  *
1027  * This function does not setup any error status, that must be done
1028  * before this function gets called.
1029  **/
1030 static void ibmvfc_scsi_eh_done(struct ibmvfc_event *evt)
1031 {
1032 	struct scsi_cmnd *cmnd = evt->cmnd;
1033 
1034 	if (cmnd) {
1035 		scsi_dma_unmap(cmnd);
1036 		cmnd->scsi_done(cmnd);
1037 	}
1038 
1039 	ibmvfc_free_event(evt);
1040 }
1041 
1042 /**
1043  * ibmvfc_complete_purge - Complete failed command list
1044  * @purge_list:		list head of failed commands
1045  *
1046  * This function runs completions on commands to fail as a result of a
1047  * host reset or platform migration.
1048  **/
1049 static void ibmvfc_complete_purge(struct list_head *purge_list)
1050 {
1051 	struct ibmvfc_event *evt, *pos;
1052 
1053 	list_for_each_entry_safe(evt, pos, purge_list, queue_list) {
1054 		list_del(&evt->queue_list);
1055 		ibmvfc_trc_end(evt);
1056 		evt->done(evt);
1057 	}
1058 }
1059 
1060 /**
1061  * ibmvfc_fail_request - Fail request with specified error code
1062  * @evt:		ibmvfc event struct
1063  * @error_code:	error code to fail request with
1064  *
1065  * Return value:
1066  *	none
1067  **/
1068 static void ibmvfc_fail_request(struct ibmvfc_event *evt, int error_code)
1069 {
1070 	if (evt->cmnd) {
1071 		evt->cmnd->result = (error_code << 16);
1072 		evt->done = ibmvfc_scsi_eh_done;
1073 	} else
1074 		evt->xfer_iu->mad_common.status = cpu_to_be16(IBMVFC_MAD_DRIVER_FAILED);
1075 
1076 	del_timer(&evt->timer);
1077 }
1078 
1079 /**
1080  * ibmvfc_purge_requests - Our virtual adapter just shut down. Purge any sent requests
1081  * @vhost:		ibmvfc host struct
1082  * @error_code:	error code to fail requests with
1083  *
1084  * Return value:
1085  *	none
1086  **/
1087 static void ibmvfc_purge_requests(struct ibmvfc_host *vhost, int error_code)
1088 {
1089 	struct ibmvfc_event *evt, *pos;
1090 	struct ibmvfc_queue *queues = vhost->scsi_scrqs.scrqs;
1091 	unsigned long flags;
1092 	int hwqs = 0;
1093 	int i;
1094 
1095 	if (vhost->using_channels)
1096 		hwqs = vhost->scsi_scrqs.active_queues;
1097 
1098 	ibmvfc_dbg(vhost, "Purging all requests\n");
1099 	spin_lock_irqsave(&vhost->crq.l_lock, flags);
1100 	list_for_each_entry_safe(evt, pos, &vhost->crq.sent, queue_list)
1101 		ibmvfc_fail_request(evt, error_code);
1102 	list_splice_init(&vhost->crq.sent, &vhost->purge);
1103 	spin_unlock_irqrestore(&vhost->crq.l_lock, flags);
1104 
1105 	for (i = 0; i < hwqs; i++) {
1106 		spin_lock_irqsave(queues[i].q_lock, flags);
1107 		spin_lock(&queues[i].l_lock);
1108 		list_for_each_entry_safe(evt, pos, &queues[i].sent, queue_list)
1109 			ibmvfc_fail_request(evt, error_code);
1110 		list_splice_init(&queues[i].sent, &vhost->purge);
1111 		spin_unlock(&queues[i].l_lock);
1112 		spin_unlock_irqrestore(queues[i].q_lock, flags);
1113 	}
1114 }
1115 
1116 /**
1117  * ibmvfc_hard_reset_host - Reset the connection to the server by breaking the CRQ
1118  * @vhost:	struct ibmvfc host to reset
1119  **/
1120 static void ibmvfc_hard_reset_host(struct ibmvfc_host *vhost)
1121 {
1122 	ibmvfc_purge_requests(vhost, DID_ERROR);
1123 	ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
1124 	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_RESET);
1125 }
1126 
1127 /**
1128  * __ibmvfc_reset_host - Reset the connection to the server (no locking)
1129  * @vhost:	struct ibmvfc host to reset
1130  **/
1131 static void __ibmvfc_reset_host(struct ibmvfc_host *vhost)
1132 {
1133 	if (vhost->logged_in && vhost->action != IBMVFC_HOST_ACTION_LOGO_WAIT &&
1134 	    !ibmvfc_set_host_state(vhost, IBMVFC_INITIALIZING)) {
1135 		scsi_block_requests(vhost->host);
1136 		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_LOGO);
1137 		vhost->job_step = ibmvfc_npiv_logout;
1138 		wake_up(&vhost->work_wait_q);
1139 	} else
1140 		ibmvfc_hard_reset_host(vhost);
1141 }
1142 
1143 /**
1144  * ibmvfc_reset_host - Reset the connection to the server
1145  * @vhost:	ibmvfc host struct
1146  **/
1147 static void ibmvfc_reset_host(struct ibmvfc_host *vhost)
1148 {
1149 	unsigned long flags;
1150 
1151 	spin_lock_irqsave(vhost->host->host_lock, flags);
1152 	__ibmvfc_reset_host(vhost);
1153 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
1154 }
1155 
1156 /**
1157  * ibmvfc_retry_host_init - Retry host initialization if allowed
1158  * @vhost:	ibmvfc host struct
1159  *
1160  * Returns: 1 if init will be retried / 0 if not
1161  *
1162  **/
1163 static int ibmvfc_retry_host_init(struct ibmvfc_host *vhost)
1164 {
1165 	int retry = 0;
1166 
1167 	if (vhost->action == IBMVFC_HOST_ACTION_INIT_WAIT) {
1168 		vhost->delay_init = 1;
1169 		if (++vhost->init_retries > IBMVFC_MAX_HOST_INIT_RETRIES) {
1170 			dev_err(vhost->dev,
1171 				"Host initialization retries exceeded. Taking adapter offline\n");
1172 			ibmvfc_link_down(vhost, IBMVFC_HOST_OFFLINE);
1173 		} else if (vhost->init_retries == IBMVFC_MAX_HOST_INIT_RETRIES)
1174 			__ibmvfc_reset_host(vhost);
1175 		else {
1176 			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT);
1177 			retry = 1;
1178 		}
1179 	}
1180 
1181 	wake_up(&vhost->work_wait_q);
1182 	return retry;
1183 }
1184 
1185 /**
1186  * __ibmvfc_get_target - Find the specified scsi_target (no locking)
1187  * @starget:	scsi target struct
1188  *
1189  * Return value:
1190  *	ibmvfc_target struct / NULL if not found
1191  **/
1192 static struct ibmvfc_target *__ibmvfc_get_target(struct scsi_target *starget)
1193 {
1194 	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
1195 	struct ibmvfc_host *vhost = shost_priv(shost);
1196 	struct ibmvfc_target *tgt;
1197 
1198 	list_for_each_entry(tgt, &vhost->targets, queue)
1199 		if (tgt->target_id == starget->id) {
1200 			kref_get(&tgt->kref);
1201 			return tgt;
1202 		}
1203 	return NULL;
1204 }
1205 
1206 /**
1207  * ibmvfc_get_target - Find the specified scsi_target
1208  * @starget:	scsi target struct
1209  *
1210  * Return value:
1211  *	ibmvfc_target struct / NULL if not found
1212  **/
1213 static struct ibmvfc_target *ibmvfc_get_target(struct scsi_target *starget)
1214 {
1215 	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
1216 	struct ibmvfc_target *tgt;
1217 	unsigned long flags;
1218 
1219 	spin_lock_irqsave(shost->host_lock, flags);
1220 	tgt = __ibmvfc_get_target(starget);
1221 	spin_unlock_irqrestore(shost->host_lock, flags);
1222 	return tgt;
1223 }
1224 
1225 /**
1226  * ibmvfc_get_host_speed - Get host port speed
1227  * @shost:		scsi host struct
1228  *
1229  * Return value:
1230  * 	none
1231  **/
1232 static void ibmvfc_get_host_speed(struct Scsi_Host *shost)
1233 {
1234 	struct ibmvfc_host *vhost = shost_priv(shost);
1235 	unsigned long flags;
1236 
1237 	spin_lock_irqsave(shost->host_lock, flags);
1238 	if (vhost->state == IBMVFC_ACTIVE) {
1239 		switch (be64_to_cpu(vhost->login_buf->resp.link_speed) / 100) {
1240 		case 1:
1241 			fc_host_speed(shost) = FC_PORTSPEED_1GBIT;
1242 			break;
1243 		case 2:
1244 			fc_host_speed(shost) = FC_PORTSPEED_2GBIT;
1245 			break;
1246 		case 4:
1247 			fc_host_speed(shost) = FC_PORTSPEED_4GBIT;
1248 			break;
1249 		case 8:
1250 			fc_host_speed(shost) = FC_PORTSPEED_8GBIT;
1251 			break;
1252 		case 10:
1253 			fc_host_speed(shost) = FC_PORTSPEED_10GBIT;
1254 			break;
1255 		case 16:
1256 			fc_host_speed(shost) = FC_PORTSPEED_16GBIT;
1257 			break;
1258 		default:
1259 			ibmvfc_log(vhost, 3, "Unknown port speed: %lld Gbit\n",
1260 				   be64_to_cpu(vhost->login_buf->resp.link_speed) / 100);
1261 			fc_host_speed(shost) = FC_PORTSPEED_UNKNOWN;
1262 			break;
1263 		}
1264 	} else
1265 		fc_host_speed(shost) = FC_PORTSPEED_UNKNOWN;
1266 	spin_unlock_irqrestore(shost->host_lock, flags);
1267 }
1268 
1269 /**
1270  * ibmvfc_get_host_port_state - Get host port state
1271  * @shost:		scsi host struct
1272  *
1273  * Return value:
1274  * 	none
1275  **/
1276 static void ibmvfc_get_host_port_state(struct Scsi_Host *shost)
1277 {
1278 	struct ibmvfc_host *vhost = shost_priv(shost);
1279 	unsigned long flags;
1280 
1281 	spin_lock_irqsave(shost->host_lock, flags);
1282 	switch (vhost->state) {
1283 	case IBMVFC_INITIALIZING:
1284 	case IBMVFC_ACTIVE:
1285 		fc_host_port_state(shost) = FC_PORTSTATE_ONLINE;
1286 		break;
1287 	case IBMVFC_LINK_DOWN:
1288 		fc_host_port_state(shost) = FC_PORTSTATE_LINKDOWN;
1289 		break;
1290 	case IBMVFC_LINK_DEAD:
1291 	case IBMVFC_HOST_OFFLINE:
1292 		fc_host_port_state(shost) = FC_PORTSTATE_OFFLINE;
1293 		break;
1294 	case IBMVFC_HALTED:
1295 		fc_host_port_state(shost) = FC_PORTSTATE_BLOCKED;
1296 		break;
1297 	case IBMVFC_NO_CRQ:
1298 		fc_host_port_state(shost) = FC_PORTSTATE_UNKNOWN;
1299 		break;
1300 	default:
1301 		ibmvfc_log(vhost, 3, "Unknown port state: %d\n", vhost->state);
1302 		fc_host_port_state(shost) = FC_PORTSTATE_UNKNOWN;
1303 		break;
1304 	}
1305 	spin_unlock_irqrestore(shost->host_lock, flags);
1306 }
1307 
1308 /**
1309  * ibmvfc_set_rport_dev_loss_tmo - Set rport's device loss timeout
1310  * @rport:		rport struct
1311  * @timeout:	timeout value
1312  *
1313  * Return value:
1314  * 	none
1315  **/
1316 static void ibmvfc_set_rport_dev_loss_tmo(struct fc_rport *rport, u32 timeout)
1317 {
1318 	if (timeout)
1319 		rport->dev_loss_tmo = timeout;
1320 	else
1321 		rport->dev_loss_tmo = 1;
1322 }
1323 
1324 /**
1325  * ibmvfc_release_tgt - Free memory allocated for a target
1326  * @kref:		kref struct
1327  *
1328  **/
1329 static void ibmvfc_release_tgt(struct kref *kref)
1330 {
1331 	struct ibmvfc_target *tgt = container_of(kref, struct ibmvfc_target, kref);
1332 	kfree(tgt);
1333 }
1334 
1335 /**
1336  * ibmvfc_get_starget_node_name - Get SCSI target's node name
1337  * @starget:	scsi target struct
1338  *
1339  * Return value:
1340  * 	none
1341  **/
1342 static void ibmvfc_get_starget_node_name(struct scsi_target *starget)
1343 {
1344 	struct ibmvfc_target *tgt = ibmvfc_get_target(starget);
1345 	fc_starget_port_name(starget) = tgt ? tgt->ids.node_name : 0;
1346 	if (tgt)
1347 		kref_put(&tgt->kref, ibmvfc_release_tgt);
1348 }
1349 
1350 /**
1351  * ibmvfc_get_starget_port_name - Get SCSI target's port name
1352  * @starget:	scsi target struct
1353  *
1354  * Return value:
1355  * 	none
1356  **/
1357 static void ibmvfc_get_starget_port_name(struct scsi_target *starget)
1358 {
1359 	struct ibmvfc_target *tgt = ibmvfc_get_target(starget);
1360 	fc_starget_port_name(starget) = tgt ? tgt->ids.port_name : 0;
1361 	if (tgt)
1362 		kref_put(&tgt->kref, ibmvfc_release_tgt);
1363 }
1364 
1365 /**
1366  * ibmvfc_get_starget_port_id - Get SCSI target's port ID
1367  * @starget:	scsi target struct
1368  *
1369  * Return value:
1370  * 	none
1371  **/
1372 static void ibmvfc_get_starget_port_id(struct scsi_target *starget)
1373 {
1374 	struct ibmvfc_target *tgt = ibmvfc_get_target(starget);
1375 	fc_starget_port_id(starget) = tgt ? tgt->scsi_id : -1;
1376 	if (tgt)
1377 		kref_put(&tgt->kref, ibmvfc_release_tgt);
1378 }
1379 
1380 /**
1381  * ibmvfc_wait_while_resetting - Wait while the host resets
1382  * @vhost:		ibmvfc host struct
1383  *
1384  * Return value:
1385  * 	0 on success / other on failure
1386  **/
1387 static int ibmvfc_wait_while_resetting(struct ibmvfc_host *vhost)
1388 {
1389 	long timeout = wait_event_timeout(vhost->init_wait_q,
1390 					  ((vhost->state == IBMVFC_ACTIVE ||
1391 					    vhost->state == IBMVFC_HOST_OFFLINE ||
1392 					    vhost->state == IBMVFC_LINK_DEAD) &&
1393 					   vhost->action == IBMVFC_HOST_ACTION_NONE),
1394 					  (init_timeout * HZ));
1395 
1396 	return timeout ? 0 : -EIO;
1397 }
1398 
1399 /**
1400  * ibmvfc_issue_fc_host_lip - Re-initiate link initialization
1401  * @shost:		scsi host struct
1402  *
1403  * Return value:
1404  * 	0 on success / other on failure
1405  **/
1406 static int ibmvfc_issue_fc_host_lip(struct Scsi_Host *shost)
1407 {
1408 	struct ibmvfc_host *vhost = shost_priv(shost);
1409 
1410 	dev_err(vhost->dev, "Initiating host LIP. Resetting connection\n");
1411 	ibmvfc_reset_host(vhost);
1412 	return ibmvfc_wait_while_resetting(vhost);
1413 }
1414 
1415 /**
1416  * ibmvfc_gather_partition_info - Gather info about the LPAR
1417  *
1418  * Return value:
1419  *	none
1420  **/
1421 static void ibmvfc_gather_partition_info(struct ibmvfc_host *vhost)
1422 {
1423 	struct device_node *rootdn;
1424 	const char *name;
1425 	const unsigned int *num;
1426 
1427 	rootdn = of_find_node_by_path("/");
1428 	if (!rootdn)
1429 		return;
1430 
1431 	name = of_get_property(rootdn, "ibm,partition-name", NULL);
1432 	if (name)
1433 		strncpy(vhost->partition_name, name, sizeof(vhost->partition_name));
1434 	num = of_get_property(rootdn, "ibm,partition-no", NULL);
1435 	if (num)
1436 		vhost->partition_number = *num;
1437 	of_node_put(rootdn);
1438 }
1439 
1440 /**
1441  * ibmvfc_set_login_info - Setup info for NPIV login
1442  * @vhost:	ibmvfc host struct
1443  *
1444  * Return value:
1445  *	none
1446  **/
1447 static void ibmvfc_set_login_info(struct ibmvfc_host *vhost)
1448 {
1449 	struct ibmvfc_npiv_login *login_info = &vhost->login_info;
1450 	struct ibmvfc_queue *async_crq = &vhost->async_crq;
1451 	struct device_node *of_node = vhost->dev->of_node;
1452 	const char *location;
1453 
1454 	memset(login_info, 0, sizeof(*login_info));
1455 
1456 	login_info->ostype = cpu_to_be32(IBMVFC_OS_LINUX);
1457 	login_info->max_dma_len = cpu_to_be64(IBMVFC_MAX_SECTORS << 9);
1458 	login_info->max_payload = cpu_to_be32(sizeof(struct ibmvfc_fcp_cmd_iu));
1459 	login_info->max_response = cpu_to_be32(sizeof(struct ibmvfc_fcp_rsp));
1460 	login_info->partition_num = cpu_to_be32(vhost->partition_number);
1461 	login_info->vfc_frame_version = cpu_to_be32(1);
1462 	login_info->fcp_version = cpu_to_be16(3);
1463 	login_info->flags = cpu_to_be16(IBMVFC_FLUSH_ON_HALT);
1464 	if (vhost->client_migrated)
1465 		login_info->flags |= cpu_to_be16(IBMVFC_CLIENT_MIGRATED);
1466 
1467 	login_info->max_cmds = cpu_to_be32(max_requests + IBMVFC_NUM_INTERNAL_REQ);
1468 	login_info->capabilities = cpu_to_be64(IBMVFC_CAN_MIGRATE | IBMVFC_CAN_SEND_VF_WWPN);
1469 
1470 	if (vhost->mq_enabled || vhost->using_channels)
1471 		login_info->capabilities |= cpu_to_be64(IBMVFC_CAN_USE_CHANNELS);
1472 
1473 	login_info->async.va = cpu_to_be64(vhost->async_crq.msg_token);
1474 	login_info->async.len = cpu_to_be32(async_crq->size *
1475 					    sizeof(*async_crq->msgs.async));
1476 	strncpy(login_info->partition_name, vhost->partition_name, IBMVFC_MAX_NAME);
1477 	strncpy(login_info->device_name,
1478 		dev_name(&vhost->host->shost_gendev), IBMVFC_MAX_NAME);
1479 
1480 	location = of_get_property(of_node, "ibm,loc-code", NULL);
1481 	location = location ? location : dev_name(vhost->dev);
1482 	strncpy(login_info->drc_name, location, IBMVFC_MAX_NAME);
1483 }
1484 
1485 /**
1486  * ibmvfc_get_event - Gets the next free event in pool
1487  * @vhost:	ibmvfc host struct
1488  *
1489  * Returns a free event from the pool.
1490  **/
1491 static struct ibmvfc_event *ibmvfc_get_event(struct ibmvfc_queue *queue)
1492 {
1493 	struct ibmvfc_event *evt;
1494 	unsigned long flags;
1495 
1496 	spin_lock_irqsave(&queue->l_lock, flags);
1497 	BUG_ON(list_empty(&queue->free));
1498 	evt = list_entry(queue->free.next, struct ibmvfc_event, queue_list);
1499 	atomic_set(&evt->free, 0);
1500 	list_del(&evt->queue_list);
1501 	spin_unlock_irqrestore(&queue->l_lock, flags);
1502 	return evt;
1503 }
1504 
1505 /**
1506  * ibmvfc_locked_done - Calls evt completion with host_lock held
1507  * @evt:	ibmvfc evt to complete
1508  *
1509  * All non-scsi command completion callbacks have the expectation that the
1510  * host_lock is held. This callback is used by ibmvfc_init_event to wrap a
1511  * MAD evt with the host_lock.
1512  **/
1513 static void ibmvfc_locked_done(struct ibmvfc_event *evt)
1514 {
1515 	unsigned long flags;
1516 
1517 	spin_lock_irqsave(evt->vhost->host->host_lock, flags);
1518 	evt->_done(evt);
1519 	spin_unlock_irqrestore(evt->vhost->host->host_lock, flags);
1520 }
1521 
1522 /**
1523  * ibmvfc_init_event - Initialize fields in an event struct that are always
1524  *				required.
1525  * @evt:	The event
1526  * @done:	Routine to call when the event is responded to
1527  * @format:	SRP or MAD format
1528  **/
1529 static void ibmvfc_init_event(struct ibmvfc_event *evt,
1530 			      void (*done) (struct ibmvfc_event *), u8 format)
1531 {
1532 	evt->cmnd = NULL;
1533 	evt->sync_iu = NULL;
1534 	evt->eh_comp = NULL;
1535 	evt->crq.format = format;
1536 	if (format == IBMVFC_CMD_FORMAT)
1537 		evt->done = done;
1538 	else {
1539 		evt->_done = done;
1540 		evt->done = ibmvfc_locked_done;
1541 	}
1542 	evt->hwq = 0;
1543 }
1544 
1545 /**
1546  * ibmvfc_map_sg_list - Initialize scatterlist
1547  * @scmd:	scsi command struct
1548  * @nseg:	number of scatterlist segments
1549  * @md:	memory descriptor list to initialize
1550  **/
1551 static void ibmvfc_map_sg_list(struct scsi_cmnd *scmd, int nseg,
1552 			       struct srp_direct_buf *md)
1553 {
1554 	int i;
1555 	struct scatterlist *sg;
1556 
1557 	scsi_for_each_sg(scmd, sg, nseg, i) {
1558 		md[i].va = cpu_to_be64(sg_dma_address(sg));
1559 		md[i].len = cpu_to_be32(sg_dma_len(sg));
1560 		md[i].key = 0;
1561 	}
1562 }
1563 
1564 /**
1565  * ibmvfc_map_sg_data - Maps dma for a scatterlist and initializes descriptor fields
1566  * @scmd:		struct scsi_cmnd with the scatterlist
1567  * @evt:		ibmvfc event struct
1568  * @vfc_cmd:	vfc_cmd that contains the memory descriptor
1569  * @dev:		device for which to map dma memory
1570  *
1571  * Returns:
1572  *	0 on success / non-zero on failure
1573  **/
1574 static int ibmvfc_map_sg_data(struct scsi_cmnd *scmd,
1575 			      struct ibmvfc_event *evt,
1576 			      struct ibmvfc_cmd *vfc_cmd, struct device *dev)
1577 {
1578 
1579 	int sg_mapped;
1580 	struct srp_direct_buf *data = &vfc_cmd->ioba;
1581 	struct ibmvfc_host *vhost = dev_get_drvdata(dev);
1582 	struct ibmvfc_fcp_cmd_iu *iu = ibmvfc_get_fcp_iu(evt->vhost, vfc_cmd);
1583 
1584 	if (cls3_error)
1585 		vfc_cmd->flags |= cpu_to_be16(IBMVFC_CLASS_3_ERR);
1586 
1587 	sg_mapped = scsi_dma_map(scmd);
1588 	if (!sg_mapped) {
1589 		vfc_cmd->flags |= cpu_to_be16(IBMVFC_NO_MEM_DESC);
1590 		return 0;
1591 	} else if (unlikely(sg_mapped < 0)) {
1592 		if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1593 			scmd_printk(KERN_ERR, scmd, "Failed to map DMA buffer for command\n");
1594 		return sg_mapped;
1595 	}
1596 
1597 	if (scmd->sc_data_direction == DMA_TO_DEVICE) {
1598 		vfc_cmd->flags |= cpu_to_be16(IBMVFC_WRITE);
1599 		iu->add_cdb_len |= IBMVFC_WRDATA;
1600 	} else {
1601 		vfc_cmd->flags |= cpu_to_be16(IBMVFC_READ);
1602 		iu->add_cdb_len |= IBMVFC_RDDATA;
1603 	}
1604 
1605 	if (sg_mapped == 1) {
1606 		ibmvfc_map_sg_list(scmd, sg_mapped, data);
1607 		return 0;
1608 	}
1609 
1610 	vfc_cmd->flags |= cpu_to_be16(IBMVFC_SCATTERLIST);
1611 
1612 	if (!evt->ext_list) {
1613 		evt->ext_list = dma_pool_alloc(vhost->sg_pool, GFP_ATOMIC,
1614 					       &evt->ext_list_token);
1615 
1616 		if (!evt->ext_list) {
1617 			scsi_dma_unmap(scmd);
1618 			if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1619 				scmd_printk(KERN_ERR, scmd, "Can't allocate memory for scatterlist\n");
1620 			return -ENOMEM;
1621 		}
1622 	}
1623 
1624 	ibmvfc_map_sg_list(scmd, sg_mapped, evt->ext_list);
1625 
1626 	data->va = cpu_to_be64(evt->ext_list_token);
1627 	data->len = cpu_to_be32(sg_mapped * sizeof(struct srp_direct_buf));
1628 	data->key = 0;
1629 	return 0;
1630 }
1631 
1632 /**
1633  * ibmvfc_timeout - Internal command timeout handler
1634  * @evt:	struct ibmvfc_event that timed out
1635  *
1636  * Called when an internally generated command times out
1637  **/
1638 static void ibmvfc_timeout(struct timer_list *t)
1639 {
1640 	struct ibmvfc_event *evt = from_timer(evt, t, timer);
1641 	struct ibmvfc_host *vhost = evt->vhost;
1642 	dev_err(vhost->dev, "Command timed out (%p). Resetting connection\n", evt);
1643 	ibmvfc_reset_host(vhost);
1644 }
1645 
1646 /**
1647  * ibmvfc_send_event - Transforms event to u64 array and calls send_crq()
1648  * @evt:		event to be sent
1649  * @vhost:		ibmvfc host struct
1650  * @timeout:	timeout in seconds - 0 means do not time command
1651  *
1652  * Returns the value returned from ibmvfc_send_crq(). (Zero for success)
1653  **/
1654 static int ibmvfc_send_event(struct ibmvfc_event *evt,
1655 			     struct ibmvfc_host *vhost, unsigned long timeout)
1656 {
1657 	__be64 *crq_as_u64 = (__be64 *) &evt->crq;
1658 	unsigned long flags;
1659 	int rc;
1660 
1661 	/* Copy the IU into the transfer area */
1662 	*evt->xfer_iu = evt->iu;
1663 	if (evt->crq.format == IBMVFC_CMD_FORMAT)
1664 		evt->xfer_iu->cmd.tag = cpu_to_be64((u64)evt);
1665 	else if (evt->crq.format == IBMVFC_MAD_FORMAT)
1666 		evt->xfer_iu->mad_common.tag = cpu_to_be64((u64)evt);
1667 	else
1668 		BUG();
1669 
1670 	timer_setup(&evt->timer, ibmvfc_timeout, 0);
1671 
1672 	if (timeout) {
1673 		evt->timer.expires = jiffies + (timeout * HZ);
1674 		add_timer(&evt->timer);
1675 	}
1676 
1677 	spin_lock_irqsave(&evt->queue->l_lock, flags);
1678 	list_add_tail(&evt->queue_list, &evt->queue->sent);
1679 
1680 	mb();
1681 
1682 	if (evt->queue->fmt == IBMVFC_SUB_CRQ_FMT)
1683 		rc = ibmvfc_send_sub_crq(vhost,
1684 					 evt->queue->vios_cookie,
1685 					 be64_to_cpu(crq_as_u64[0]),
1686 					 be64_to_cpu(crq_as_u64[1]),
1687 					 0, 0);
1688 	else
1689 		rc = ibmvfc_send_crq(vhost, be64_to_cpu(crq_as_u64[0]),
1690 				     be64_to_cpu(crq_as_u64[1]));
1691 
1692 	if (rc) {
1693 		list_del(&evt->queue_list);
1694 		spin_unlock_irqrestore(&evt->queue->l_lock, flags);
1695 		del_timer(&evt->timer);
1696 
1697 		/* If send_crq returns H_CLOSED, return SCSI_MLQUEUE_HOST_BUSY.
1698 		 * Firmware will send a CRQ with a transport event (0xFF) to
1699 		 * tell this client what has happened to the transport. This
1700 		 * will be handled in ibmvfc_handle_crq()
1701 		 */
1702 		if (rc == H_CLOSED) {
1703 			if (printk_ratelimit())
1704 				dev_warn(vhost->dev, "Send warning. Receive queue closed, will retry.\n");
1705 			if (evt->cmnd)
1706 				scsi_dma_unmap(evt->cmnd);
1707 			ibmvfc_free_event(evt);
1708 			return SCSI_MLQUEUE_HOST_BUSY;
1709 		}
1710 
1711 		dev_err(vhost->dev, "Send error (rc=%d)\n", rc);
1712 		if (evt->cmnd) {
1713 			evt->cmnd->result = DID_ERROR << 16;
1714 			evt->done = ibmvfc_scsi_eh_done;
1715 		} else
1716 			evt->xfer_iu->mad_common.status = cpu_to_be16(IBMVFC_MAD_CRQ_ERROR);
1717 
1718 		evt->done(evt);
1719 	} else {
1720 		spin_unlock_irqrestore(&evt->queue->l_lock, flags);
1721 		ibmvfc_trc_start(evt);
1722 	}
1723 
1724 	return 0;
1725 }
1726 
1727 /**
1728  * ibmvfc_log_error - Log an error for the failed command if appropriate
1729  * @evt:	ibmvfc event to log
1730  *
1731  **/
1732 static void ibmvfc_log_error(struct ibmvfc_event *evt)
1733 {
1734 	struct ibmvfc_cmd *vfc_cmd = &evt->xfer_iu->cmd;
1735 	struct ibmvfc_host *vhost = evt->vhost;
1736 	struct ibmvfc_fcp_rsp *rsp = ibmvfc_get_fcp_rsp(vhost, vfc_cmd);
1737 	struct scsi_cmnd *cmnd = evt->cmnd;
1738 	const char *err = unknown_error;
1739 	int index = ibmvfc_get_err_index(be16_to_cpu(vfc_cmd->status), be16_to_cpu(vfc_cmd->error));
1740 	int logerr = 0;
1741 	int rsp_code = 0;
1742 
1743 	if (index >= 0) {
1744 		logerr = cmd_status[index].log;
1745 		err = cmd_status[index].name;
1746 	}
1747 
1748 	if (!logerr && (vhost->log_level <= (IBMVFC_DEFAULT_LOG_LEVEL + 1)))
1749 		return;
1750 
1751 	if (rsp->flags & FCP_RSP_LEN_VALID)
1752 		rsp_code = rsp->data.info.rsp_code;
1753 
1754 	scmd_printk(KERN_ERR, cmnd, "Command (%02X) : %s (%x:%x) "
1755 		    "flags: %x fcp_rsp: %x, resid=%d, scsi_status: %x\n",
1756 		    cmnd->cmnd[0], err, be16_to_cpu(vfc_cmd->status), be16_to_cpu(vfc_cmd->error),
1757 		    rsp->flags, rsp_code, scsi_get_resid(cmnd), rsp->scsi_status);
1758 }
1759 
1760 /**
1761  * ibmvfc_relogin - Log back into the specified device
1762  * @sdev:	scsi device struct
1763  *
1764  **/
1765 static void ibmvfc_relogin(struct scsi_device *sdev)
1766 {
1767 	struct ibmvfc_host *vhost = shost_priv(sdev->host);
1768 	struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
1769 	struct ibmvfc_target *tgt;
1770 	unsigned long flags;
1771 
1772 	spin_lock_irqsave(vhost->host->host_lock, flags);
1773 	list_for_each_entry(tgt, &vhost->targets, queue) {
1774 		if (rport == tgt->rport) {
1775 			ibmvfc_del_tgt(tgt);
1776 			break;
1777 		}
1778 	}
1779 
1780 	ibmvfc_reinit_host(vhost);
1781 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
1782 }
1783 
1784 /**
1785  * ibmvfc_scsi_done - Handle responses from commands
1786  * @evt:	ibmvfc event to be handled
1787  *
1788  * Used as a callback when sending scsi cmds.
1789  **/
1790 static void ibmvfc_scsi_done(struct ibmvfc_event *evt)
1791 {
1792 	struct ibmvfc_cmd *vfc_cmd = &evt->xfer_iu->cmd;
1793 	struct ibmvfc_fcp_rsp *rsp = ibmvfc_get_fcp_rsp(evt->vhost, vfc_cmd);
1794 	struct scsi_cmnd *cmnd = evt->cmnd;
1795 	u32 rsp_len = 0;
1796 	u32 sense_len = be32_to_cpu(rsp->fcp_sense_len);
1797 
1798 	if (cmnd) {
1799 		if (be16_to_cpu(vfc_cmd->response_flags) & IBMVFC_ADAPTER_RESID_VALID)
1800 			scsi_set_resid(cmnd, be32_to_cpu(vfc_cmd->adapter_resid));
1801 		else if (rsp->flags & FCP_RESID_UNDER)
1802 			scsi_set_resid(cmnd, be32_to_cpu(rsp->fcp_resid));
1803 		else
1804 			scsi_set_resid(cmnd, 0);
1805 
1806 		if (vfc_cmd->status) {
1807 			cmnd->result = ibmvfc_get_err_result(evt->vhost, vfc_cmd);
1808 
1809 			if (rsp->flags & FCP_RSP_LEN_VALID)
1810 				rsp_len = be32_to_cpu(rsp->fcp_rsp_len);
1811 			if ((sense_len + rsp_len) > SCSI_SENSE_BUFFERSIZE)
1812 				sense_len = SCSI_SENSE_BUFFERSIZE - rsp_len;
1813 			if ((rsp->flags & FCP_SNS_LEN_VALID) && rsp->fcp_sense_len && rsp_len <= 8)
1814 				memcpy(cmnd->sense_buffer, rsp->data.sense + rsp_len, sense_len);
1815 			if ((be16_to_cpu(vfc_cmd->status) & IBMVFC_VIOS_FAILURE) &&
1816 			    (be16_to_cpu(vfc_cmd->error) == IBMVFC_PLOGI_REQUIRED))
1817 				ibmvfc_relogin(cmnd->device);
1818 
1819 			if (!cmnd->result && (!scsi_get_resid(cmnd) || (rsp->flags & FCP_RESID_OVER)))
1820 				cmnd->result = (DID_ERROR << 16);
1821 
1822 			ibmvfc_log_error(evt);
1823 		}
1824 
1825 		if (!cmnd->result &&
1826 		    (scsi_bufflen(cmnd) - scsi_get_resid(cmnd) < cmnd->underflow))
1827 			cmnd->result = (DID_ERROR << 16);
1828 
1829 		scsi_dma_unmap(cmnd);
1830 		cmnd->scsi_done(cmnd);
1831 	}
1832 
1833 	ibmvfc_free_event(evt);
1834 }
1835 
1836 /**
1837  * ibmvfc_host_chkready - Check if the host can accept commands
1838  * @vhost:	 struct ibmvfc host
1839  *
1840  * Returns:
1841  *	1 if host can accept command / 0 if not
1842  **/
1843 static inline int ibmvfc_host_chkready(struct ibmvfc_host *vhost)
1844 {
1845 	int result = 0;
1846 
1847 	switch (vhost->state) {
1848 	case IBMVFC_LINK_DEAD:
1849 	case IBMVFC_HOST_OFFLINE:
1850 		result = DID_NO_CONNECT << 16;
1851 		break;
1852 	case IBMVFC_NO_CRQ:
1853 	case IBMVFC_INITIALIZING:
1854 	case IBMVFC_HALTED:
1855 	case IBMVFC_LINK_DOWN:
1856 		result = DID_REQUEUE << 16;
1857 		break;
1858 	case IBMVFC_ACTIVE:
1859 		result = 0;
1860 		break;
1861 	}
1862 
1863 	return result;
1864 }
1865 
1866 static struct ibmvfc_cmd *ibmvfc_init_vfc_cmd(struct ibmvfc_event *evt, struct scsi_device *sdev)
1867 {
1868 	struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
1869 	struct ibmvfc_host *vhost = evt->vhost;
1870 	struct ibmvfc_cmd *vfc_cmd = &evt->iu.cmd;
1871 	struct ibmvfc_fcp_cmd_iu *iu = ibmvfc_get_fcp_iu(vhost, vfc_cmd);
1872 	struct ibmvfc_fcp_rsp *rsp = ibmvfc_get_fcp_rsp(vhost, vfc_cmd);
1873 	size_t offset;
1874 
1875 	memset(vfc_cmd, 0, sizeof(*vfc_cmd));
1876 	if (ibmvfc_check_caps(vhost, IBMVFC_HANDLE_VF_WWPN)) {
1877 		offset = offsetof(struct ibmvfc_cmd, v2.rsp);
1878 		vfc_cmd->target_wwpn = cpu_to_be64(rport->port_name);
1879 	} else
1880 		offset = offsetof(struct ibmvfc_cmd, v1.rsp);
1881 	vfc_cmd->resp.va = cpu_to_be64(be64_to_cpu(evt->crq.ioba) + offset);
1882 	vfc_cmd->resp.len = cpu_to_be32(sizeof(*rsp));
1883 	vfc_cmd->frame_type = cpu_to_be32(IBMVFC_SCSI_FCP_TYPE);
1884 	vfc_cmd->payload_len = cpu_to_be32(sizeof(*iu));
1885 	vfc_cmd->resp_len = cpu_to_be32(sizeof(*rsp));
1886 	vfc_cmd->cancel_key = cpu_to_be32((unsigned long)sdev->hostdata);
1887 	vfc_cmd->tgt_scsi_id = cpu_to_be64(rport->port_id);
1888 	int_to_scsilun(sdev->lun, &iu->lun);
1889 
1890 	return vfc_cmd;
1891 }
1892 
1893 /**
1894  * ibmvfc_queuecommand - The queuecommand function of the scsi template
1895  * @cmnd:	struct scsi_cmnd to be executed
1896  * @done:	Callback function to be called when cmnd is completed
1897  *
1898  * Returns:
1899  *	0 on success / other on failure
1900  **/
1901 static int ibmvfc_queuecommand(struct Scsi_Host *shost, struct scsi_cmnd *cmnd)
1902 {
1903 	struct ibmvfc_host *vhost = shost_priv(shost);
1904 	struct fc_rport *rport = starget_to_rport(scsi_target(cmnd->device));
1905 	struct ibmvfc_cmd *vfc_cmd;
1906 	struct ibmvfc_fcp_cmd_iu *iu;
1907 	struct ibmvfc_event *evt;
1908 	u32 tag_and_hwq = blk_mq_unique_tag(cmnd->request);
1909 	u16 hwq = blk_mq_unique_tag_to_hwq(tag_and_hwq);
1910 	u16 scsi_channel;
1911 	int rc;
1912 
1913 	if (unlikely((rc = fc_remote_port_chkready(rport))) ||
1914 	    unlikely((rc = ibmvfc_host_chkready(vhost)))) {
1915 		cmnd->result = rc;
1916 		cmnd->scsi_done(cmnd);
1917 		return 0;
1918 	}
1919 
1920 	cmnd->result = (DID_OK << 16);
1921 	if (vhost->using_channels) {
1922 		scsi_channel = hwq % vhost->scsi_scrqs.active_queues;
1923 		evt = ibmvfc_get_event(&vhost->scsi_scrqs.scrqs[scsi_channel]);
1924 		evt->hwq = hwq % vhost->scsi_scrqs.active_queues;
1925 	} else
1926 		evt = ibmvfc_get_event(&vhost->crq);
1927 
1928 	ibmvfc_init_event(evt, ibmvfc_scsi_done, IBMVFC_CMD_FORMAT);
1929 	evt->cmnd = cmnd;
1930 
1931 	vfc_cmd = ibmvfc_init_vfc_cmd(evt, cmnd->device);
1932 	iu = ibmvfc_get_fcp_iu(vhost, vfc_cmd);
1933 
1934 	iu->xfer_len = cpu_to_be32(scsi_bufflen(cmnd));
1935 	memcpy(iu->cdb, cmnd->cmnd, cmnd->cmd_len);
1936 
1937 	if (cmnd->flags & SCMD_TAGGED) {
1938 		vfc_cmd->task_tag = cpu_to_be64(cmnd->tag);
1939 		iu->pri_task_attr = IBMVFC_SIMPLE_TASK;
1940 	}
1941 
1942 	vfc_cmd->correlation = cpu_to_be64((u64)evt);
1943 
1944 	if (likely(!(rc = ibmvfc_map_sg_data(cmnd, evt, vfc_cmd, vhost->dev))))
1945 		return ibmvfc_send_event(evt, vhost, 0);
1946 
1947 	ibmvfc_free_event(evt);
1948 	if (rc == -ENOMEM)
1949 		return SCSI_MLQUEUE_HOST_BUSY;
1950 
1951 	if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1952 		scmd_printk(KERN_ERR, cmnd,
1953 			    "Failed to map DMA buffer for command. rc=%d\n", rc);
1954 
1955 	cmnd->result = DID_ERROR << 16;
1956 	cmnd->scsi_done(cmnd);
1957 	return 0;
1958 }
1959 
1960 /**
1961  * ibmvfc_sync_completion - Signal that a synchronous command has completed
1962  * @evt:	ibmvfc event struct
1963  *
1964  **/
1965 static void ibmvfc_sync_completion(struct ibmvfc_event *evt)
1966 {
1967 	/* copy the response back */
1968 	if (evt->sync_iu)
1969 		*evt->sync_iu = *evt->xfer_iu;
1970 
1971 	complete(&evt->comp);
1972 }
1973 
1974 /**
1975  * ibmvfc_bsg_timeout_done - Completion handler for cancelling BSG commands
1976  * @evt:	struct ibmvfc_event
1977  *
1978  **/
1979 static void ibmvfc_bsg_timeout_done(struct ibmvfc_event *evt)
1980 {
1981 	struct ibmvfc_host *vhost = evt->vhost;
1982 
1983 	ibmvfc_free_event(evt);
1984 	vhost->aborting_passthru = 0;
1985 	dev_info(vhost->dev, "Passthru command cancelled\n");
1986 }
1987 
1988 /**
1989  * ibmvfc_bsg_timeout - Handle a BSG timeout
1990  * @job:	struct bsg_job that timed out
1991  *
1992  * Returns:
1993  *	0 on success / other on failure
1994  **/
1995 static int ibmvfc_bsg_timeout(struct bsg_job *job)
1996 {
1997 	struct ibmvfc_host *vhost = shost_priv(fc_bsg_to_shost(job));
1998 	unsigned long port_id = (unsigned long)job->dd_data;
1999 	struct ibmvfc_event *evt;
2000 	struct ibmvfc_tmf *tmf;
2001 	unsigned long flags;
2002 	int rc;
2003 
2004 	ENTER;
2005 	spin_lock_irqsave(vhost->host->host_lock, flags);
2006 	if (vhost->aborting_passthru || vhost->state != IBMVFC_ACTIVE) {
2007 		__ibmvfc_reset_host(vhost);
2008 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
2009 		return 0;
2010 	}
2011 
2012 	vhost->aborting_passthru = 1;
2013 	evt = ibmvfc_get_event(&vhost->crq);
2014 	ibmvfc_init_event(evt, ibmvfc_bsg_timeout_done, IBMVFC_MAD_FORMAT);
2015 
2016 	tmf = &evt->iu.tmf;
2017 	memset(tmf, 0, sizeof(*tmf));
2018 	tmf->common.version = cpu_to_be32(1);
2019 	tmf->common.opcode = cpu_to_be32(IBMVFC_TMF_MAD);
2020 	tmf->common.length = cpu_to_be16(sizeof(*tmf));
2021 	tmf->scsi_id = cpu_to_be64(port_id);
2022 	tmf->cancel_key = cpu_to_be32(IBMVFC_PASSTHRU_CANCEL_KEY);
2023 	tmf->my_cancel_key = cpu_to_be32(IBMVFC_INTERNAL_CANCEL_KEY);
2024 	rc = ibmvfc_send_event(evt, vhost, default_timeout);
2025 
2026 	if (rc != 0) {
2027 		vhost->aborting_passthru = 0;
2028 		dev_err(vhost->dev, "Failed to send cancel event. rc=%d\n", rc);
2029 		rc = -EIO;
2030 	} else
2031 		dev_info(vhost->dev, "Cancelling passthru command to port id 0x%lx\n",
2032 			 port_id);
2033 
2034 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2035 
2036 	LEAVE;
2037 	return rc;
2038 }
2039 
2040 /**
2041  * ibmvfc_bsg_plogi - PLOGI into a target to handle a BSG command
2042  * @vhost:		struct ibmvfc_host to send command
2043  * @port_id:	port ID to send command
2044  *
2045  * Returns:
2046  *	0 on success / other on failure
2047  **/
2048 static int ibmvfc_bsg_plogi(struct ibmvfc_host *vhost, unsigned int port_id)
2049 {
2050 	struct ibmvfc_port_login *plogi;
2051 	struct ibmvfc_target *tgt;
2052 	struct ibmvfc_event *evt;
2053 	union ibmvfc_iu rsp_iu;
2054 	unsigned long flags;
2055 	int rc = 0, issue_login = 1;
2056 
2057 	ENTER;
2058 	spin_lock_irqsave(vhost->host->host_lock, flags);
2059 	list_for_each_entry(tgt, &vhost->targets, queue) {
2060 		if (tgt->scsi_id == port_id) {
2061 			issue_login = 0;
2062 			break;
2063 		}
2064 	}
2065 
2066 	if (!issue_login)
2067 		goto unlock_out;
2068 	if (unlikely((rc = ibmvfc_host_chkready(vhost))))
2069 		goto unlock_out;
2070 
2071 	evt = ibmvfc_get_event(&vhost->crq);
2072 	ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_MAD_FORMAT);
2073 	plogi = &evt->iu.plogi;
2074 	memset(plogi, 0, sizeof(*plogi));
2075 	plogi->common.version = cpu_to_be32(1);
2076 	plogi->common.opcode = cpu_to_be32(IBMVFC_PORT_LOGIN);
2077 	plogi->common.length = cpu_to_be16(sizeof(*plogi));
2078 	plogi->scsi_id = cpu_to_be64(port_id);
2079 	evt->sync_iu = &rsp_iu;
2080 	init_completion(&evt->comp);
2081 
2082 	rc = ibmvfc_send_event(evt, vhost, default_timeout);
2083 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2084 
2085 	if (rc)
2086 		return -EIO;
2087 
2088 	wait_for_completion(&evt->comp);
2089 
2090 	if (rsp_iu.plogi.common.status)
2091 		rc = -EIO;
2092 
2093 	spin_lock_irqsave(vhost->host->host_lock, flags);
2094 	ibmvfc_free_event(evt);
2095 unlock_out:
2096 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2097 	LEAVE;
2098 	return rc;
2099 }
2100 
2101 /**
2102  * ibmvfc_bsg_request - Handle a BSG request
2103  * @job:	struct bsg_job to be executed
2104  *
2105  * Returns:
2106  *	0 on success / other on failure
2107  **/
2108 static int ibmvfc_bsg_request(struct bsg_job *job)
2109 {
2110 	struct ibmvfc_host *vhost = shost_priv(fc_bsg_to_shost(job));
2111 	struct fc_rport *rport = fc_bsg_to_rport(job);
2112 	struct ibmvfc_passthru_mad *mad;
2113 	struct ibmvfc_event *evt;
2114 	union ibmvfc_iu rsp_iu;
2115 	unsigned long flags, port_id = -1;
2116 	struct fc_bsg_request *bsg_request = job->request;
2117 	struct fc_bsg_reply *bsg_reply = job->reply;
2118 	unsigned int code = bsg_request->msgcode;
2119 	int rc = 0, req_seg, rsp_seg, issue_login = 0;
2120 	u32 fc_flags, rsp_len;
2121 
2122 	ENTER;
2123 	bsg_reply->reply_payload_rcv_len = 0;
2124 	if (rport)
2125 		port_id = rport->port_id;
2126 
2127 	switch (code) {
2128 	case FC_BSG_HST_ELS_NOLOGIN:
2129 		port_id = (bsg_request->rqst_data.h_els.port_id[0] << 16) |
2130 			(bsg_request->rqst_data.h_els.port_id[1] << 8) |
2131 			bsg_request->rqst_data.h_els.port_id[2];
2132 		fallthrough;
2133 	case FC_BSG_RPT_ELS:
2134 		fc_flags = IBMVFC_FC_ELS;
2135 		break;
2136 	case FC_BSG_HST_CT:
2137 		issue_login = 1;
2138 		port_id = (bsg_request->rqst_data.h_ct.port_id[0] << 16) |
2139 			(bsg_request->rqst_data.h_ct.port_id[1] << 8) |
2140 			bsg_request->rqst_data.h_ct.port_id[2];
2141 		fallthrough;
2142 	case FC_BSG_RPT_CT:
2143 		fc_flags = IBMVFC_FC_CT_IU;
2144 		break;
2145 	default:
2146 		return -ENOTSUPP;
2147 	}
2148 
2149 	if (port_id == -1)
2150 		return -EINVAL;
2151 	if (!mutex_trylock(&vhost->passthru_mutex))
2152 		return -EBUSY;
2153 
2154 	job->dd_data = (void *)port_id;
2155 	req_seg = dma_map_sg(vhost->dev, job->request_payload.sg_list,
2156 			     job->request_payload.sg_cnt, DMA_TO_DEVICE);
2157 
2158 	if (!req_seg) {
2159 		mutex_unlock(&vhost->passthru_mutex);
2160 		return -ENOMEM;
2161 	}
2162 
2163 	rsp_seg = dma_map_sg(vhost->dev, job->reply_payload.sg_list,
2164 			     job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
2165 
2166 	if (!rsp_seg) {
2167 		dma_unmap_sg(vhost->dev, job->request_payload.sg_list,
2168 			     job->request_payload.sg_cnt, DMA_TO_DEVICE);
2169 		mutex_unlock(&vhost->passthru_mutex);
2170 		return -ENOMEM;
2171 	}
2172 
2173 	if (req_seg > 1 || rsp_seg > 1) {
2174 		rc = -EINVAL;
2175 		goto out;
2176 	}
2177 
2178 	if (issue_login)
2179 		rc = ibmvfc_bsg_plogi(vhost, port_id);
2180 
2181 	spin_lock_irqsave(vhost->host->host_lock, flags);
2182 
2183 	if (unlikely(rc || (rport && (rc = fc_remote_port_chkready(rport)))) ||
2184 	    unlikely((rc = ibmvfc_host_chkready(vhost)))) {
2185 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
2186 		goto out;
2187 	}
2188 
2189 	evt = ibmvfc_get_event(&vhost->crq);
2190 	ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_MAD_FORMAT);
2191 	mad = &evt->iu.passthru;
2192 
2193 	memset(mad, 0, sizeof(*mad));
2194 	mad->common.version = cpu_to_be32(1);
2195 	mad->common.opcode = cpu_to_be32(IBMVFC_PASSTHRU);
2196 	mad->common.length = cpu_to_be16(sizeof(*mad) - sizeof(mad->fc_iu) - sizeof(mad->iu));
2197 
2198 	mad->cmd_ioba.va = cpu_to_be64(be64_to_cpu(evt->crq.ioba) +
2199 		offsetof(struct ibmvfc_passthru_mad, iu));
2200 	mad->cmd_ioba.len = cpu_to_be32(sizeof(mad->iu));
2201 
2202 	mad->iu.cmd_len = cpu_to_be32(job->request_payload.payload_len);
2203 	mad->iu.rsp_len = cpu_to_be32(job->reply_payload.payload_len);
2204 	mad->iu.flags = cpu_to_be32(fc_flags);
2205 	mad->iu.cancel_key = cpu_to_be32(IBMVFC_PASSTHRU_CANCEL_KEY);
2206 
2207 	mad->iu.cmd.va = cpu_to_be64(sg_dma_address(job->request_payload.sg_list));
2208 	mad->iu.cmd.len = cpu_to_be32(sg_dma_len(job->request_payload.sg_list));
2209 	mad->iu.rsp.va = cpu_to_be64(sg_dma_address(job->reply_payload.sg_list));
2210 	mad->iu.rsp.len = cpu_to_be32(sg_dma_len(job->reply_payload.sg_list));
2211 	mad->iu.scsi_id = cpu_to_be64(port_id);
2212 	mad->iu.tag = cpu_to_be64((u64)evt);
2213 	rsp_len = be32_to_cpu(mad->iu.rsp.len);
2214 
2215 	evt->sync_iu = &rsp_iu;
2216 	init_completion(&evt->comp);
2217 	rc = ibmvfc_send_event(evt, vhost, 0);
2218 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2219 
2220 	if (rc) {
2221 		rc = -EIO;
2222 		goto out;
2223 	}
2224 
2225 	wait_for_completion(&evt->comp);
2226 
2227 	if (rsp_iu.passthru.common.status)
2228 		rc = -EIO;
2229 	else
2230 		bsg_reply->reply_payload_rcv_len = rsp_len;
2231 
2232 	spin_lock_irqsave(vhost->host->host_lock, flags);
2233 	ibmvfc_free_event(evt);
2234 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2235 	bsg_reply->result = rc;
2236 	bsg_job_done(job, bsg_reply->result,
2237 		       bsg_reply->reply_payload_rcv_len);
2238 	rc = 0;
2239 out:
2240 	dma_unmap_sg(vhost->dev, job->request_payload.sg_list,
2241 		     job->request_payload.sg_cnt, DMA_TO_DEVICE);
2242 	dma_unmap_sg(vhost->dev, job->reply_payload.sg_list,
2243 		     job->reply_payload.sg_cnt, DMA_FROM_DEVICE);
2244 	mutex_unlock(&vhost->passthru_mutex);
2245 	LEAVE;
2246 	return rc;
2247 }
2248 
2249 /**
2250  * ibmvfc_reset_device - Reset the device with the specified reset type
2251  * @sdev:	scsi device to reset
2252  * @type:	reset type
2253  * @desc:	reset type description for log messages
2254  *
2255  * Returns:
2256  *	0 on success / other on failure
2257  **/
2258 static int ibmvfc_reset_device(struct scsi_device *sdev, int type, char *desc)
2259 {
2260 	struct ibmvfc_host *vhost = shost_priv(sdev->host);
2261 	struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
2262 	struct ibmvfc_cmd *tmf;
2263 	struct ibmvfc_event *evt = NULL;
2264 	union ibmvfc_iu rsp_iu;
2265 	struct ibmvfc_fcp_cmd_iu *iu;
2266 	struct ibmvfc_fcp_rsp *fc_rsp = ibmvfc_get_fcp_rsp(vhost, &rsp_iu.cmd);
2267 	int rsp_rc = -EBUSY;
2268 	unsigned long flags;
2269 	int rsp_code = 0;
2270 
2271 	spin_lock_irqsave(vhost->host->host_lock, flags);
2272 	if (vhost->state == IBMVFC_ACTIVE) {
2273 		if (vhost->using_channels)
2274 			evt = ibmvfc_get_event(&vhost->scsi_scrqs.scrqs[0]);
2275 		else
2276 			evt = ibmvfc_get_event(&vhost->crq);
2277 
2278 		ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_CMD_FORMAT);
2279 		tmf = ibmvfc_init_vfc_cmd(evt, sdev);
2280 		iu = ibmvfc_get_fcp_iu(vhost, tmf);
2281 
2282 		tmf->flags = cpu_to_be16((IBMVFC_NO_MEM_DESC | IBMVFC_TMF));
2283 		if (ibmvfc_check_caps(vhost, IBMVFC_HANDLE_VF_WWPN))
2284 			tmf->target_wwpn = cpu_to_be64(rport->port_name);
2285 		iu->tmf_flags = type;
2286 		evt->sync_iu = &rsp_iu;
2287 
2288 		init_completion(&evt->comp);
2289 		rsp_rc = ibmvfc_send_event(evt, vhost, default_timeout);
2290 	}
2291 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2292 
2293 	if (rsp_rc != 0) {
2294 		sdev_printk(KERN_ERR, sdev, "Failed to send %s reset event. rc=%d\n",
2295 			    desc, rsp_rc);
2296 		return -EIO;
2297 	}
2298 
2299 	sdev_printk(KERN_INFO, sdev, "Resetting %s\n", desc);
2300 	wait_for_completion(&evt->comp);
2301 
2302 	if (rsp_iu.cmd.status)
2303 		rsp_code = ibmvfc_get_err_result(vhost, &rsp_iu.cmd);
2304 
2305 	if (rsp_code) {
2306 		if (fc_rsp->flags & FCP_RSP_LEN_VALID)
2307 			rsp_code = fc_rsp->data.info.rsp_code;
2308 
2309 		sdev_printk(KERN_ERR, sdev, "%s reset failed: %s (%x:%x) "
2310 			    "flags: %x fcp_rsp: %x, scsi_status: %x\n", desc,
2311 			    ibmvfc_get_cmd_error(be16_to_cpu(rsp_iu.cmd.status), be16_to_cpu(rsp_iu.cmd.error)),
2312 			    be16_to_cpu(rsp_iu.cmd.status), be16_to_cpu(rsp_iu.cmd.error), fc_rsp->flags, rsp_code,
2313 			    fc_rsp->scsi_status);
2314 		rsp_rc = -EIO;
2315 	} else
2316 		sdev_printk(KERN_INFO, sdev, "%s reset successful\n", desc);
2317 
2318 	spin_lock_irqsave(vhost->host->host_lock, flags);
2319 	ibmvfc_free_event(evt);
2320 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2321 	return rsp_rc;
2322 }
2323 
2324 /**
2325  * ibmvfc_match_rport - Match function for specified remote port
2326  * @evt:	ibmvfc event struct
2327  * @device:	device to match (rport)
2328  *
2329  * Returns:
2330  *	1 if event matches rport / 0 if event does not match rport
2331  **/
2332 static int ibmvfc_match_rport(struct ibmvfc_event *evt, void *rport)
2333 {
2334 	struct fc_rport *cmd_rport;
2335 
2336 	if (evt->cmnd) {
2337 		cmd_rport = starget_to_rport(scsi_target(evt->cmnd->device));
2338 		if (cmd_rport == rport)
2339 			return 1;
2340 	}
2341 	return 0;
2342 }
2343 
2344 /**
2345  * ibmvfc_match_target - Match function for specified target
2346  * @evt:	ibmvfc event struct
2347  * @device:	device to match (starget)
2348  *
2349  * Returns:
2350  *	1 if event matches starget / 0 if event does not match starget
2351  **/
2352 static int ibmvfc_match_target(struct ibmvfc_event *evt, void *device)
2353 {
2354 	if (evt->cmnd && scsi_target(evt->cmnd->device) == device)
2355 		return 1;
2356 	return 0;
2357 }
2358 
2359 /**
2360  * ibmvfc_match_lun - Match function for specified LUN
2361  * @evt:	ibmvfc event struct
2362  * @device:	device to match (sdev)
2363  *
2364  * Returns:
2365  *	1 if event matches sdev / 0 if event does not match sdev
2366  **/
2367 static int ibmvfc_match_lun(struct ibmvfc_event *evt, void *device)
2368 {
2369 	if (evt->cmnd && evt->cmnd->device == device)
2370 		return 1;
2371 	return 0;
2372 }
2373 
2374 /**
2375  * ibmvfc_event_is_free - Check if event is free or not
2376  * @evt:	ibmvfc event struct
2377  *
2378  * Returns:
2379  *	true / false
2380  **/
2381 static bool ibmvfc_event_is_free(struct ibmvfc_event *evt)
2382 {
2383 	struct ibmvfc_event *loop_evt;
2384 
2385 	list_for_each_entry(loop_evt, &evt->queue->free, queue_list)
2386 		if (loop_evt == evt)
2387 			return true;
2388 
2389 	return false;
2390 }
2391 
2392 /**
2393  * ibmvfc_wait_for_ops - Wait for ops to complete
2394  * @vhost:	ibmvfc host struct
2395  * @device:	device to match (starget or sdev)
2396  * @match:	match function
2397  *
2398  * Returns:
2399  *	SUCCESS / FAILED
2400  **/
2401 static int ibmvfc_wait_for_ops(struct ibmvfc_host *vhost, void *device,
2402 			       int (*match) (struct ibmvfc_event *, void *))
2403 {
2404 	struct ibmvfc_event *evt;
2405 	DECLARE_COMPLETION_ONSTACK(comp);
2406 	int wait, i, q_index, q_size;
2407 	unsigned long flags;
2408 	signed long timeout = IBMVFC_ABORT_WAIT_TIMEOUT * HZ;
2409 	struct ibmvfc_queue *queues;
2410 
2411 	ENTER;
2412 	if (vhost->mq_enabled && vhost->using_channels) {
2413 		queues = vhost->scsi_scrqs.scrqs;
2414 		q_size = vhost->scsi_scrqs.active_queues;
2415 	} else {
2416 		queues = &vhost->crq;
2417 		q_size = 1;
2418 	}
2419 
2420 	do {
2421 		wait = 0;
2422 		spin_lock_irqsave(vhost->host->host_lock, flags);
2423 		for (q_index = 0; q_index < q_size; q_index++) {
2424 			spin_lock(&queues[q_index].l_lock);
2425 			for (i = 0; i < queues[q_index].evt_pool.size; i++) {
2426 				evt = &queues[q_index].evt_pool.events[i];
2427 				if (!ibmvfc_event_is_free(evt)) {
2428 					if (match(evt, device)) {
2429 						evt->eh_comp = &comp;
2430 						wait++;
2431 					}
2432 				}
2433 			}
2434 			spin_unlock(&queues[q_index].l_lock);
2435 		}
2436 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
2437 
2438 		if (wait) {
2439 			timeout = wait_for_completion_timeout(&comp, timeout);
2440 
2441 			if (!timeout) {
2442 				wait = 0;
2443 				spin_lock_irqsave(vhost->host->host_lock, flags);
2444 				for (q_index = 0; q_index < q_size; q_index++) {
2445 					spin_lock(&queues[q_index].l_lock);
2446 					for (i = 0; i < queues[q_index].evt_pool.size; i++) {
2447 						evt = &queues[q_index].evt_pool.events[i];
2448 						if (!ibmvfc_event_is_free(evt)) {
2449 							if (match(evt, device)) {
2450 								evt->eh_comp = NULL;
2451 								wait++;
2452 							}
2453 						}
2454 					}
2455 					spin_unlock(&queues[q_index].l_lock);
2456 				}
2457 				spin_unlock_irqrestore(vhost->host->host_lock, flags);
2458 				if (wait)
2459 					dev_err(vhost->dev, "Timed out waiting for aborted commands\n");
2460 				LEAVE;
2461 				return wait ? FAILED : SUCCESS;
2462 			}
2463 		}
2464 	} while (wait);
2465 
2466 	LEAVE;
2467 	return SUCCESS;
2468 }
2469 
2470 static struct ibmvfc_event *ibmvfc_init_tmf(struct ibmvfc_queue *queue,
2471 					    struct scsi_device *sdev,
2472 					    int type)
2473 {
2474 	struct ibmvfc_host *vhost = shost_priv(sdev->host);
2475 	struct scsi_target *starget = scsi_target(sdev);
2476 	struct fc_rport *rport = starget_to_rport(starget);
2477 	struct ibmvfc_event *evt;
2478 	struct ibmvfc_tmf *tmf;
2479 
2480 	evt = ibmvfc_get_event(queue);
2481 	ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_MAD_FORMAT);
2482 
2483 	tmf = &evt->iu.tmf;
2484 	memset(tmf, 0, sizeof(*tmf));
2485 	if (ibmvfc_check_caps(vhost, IBMVFC_HANDLE_VF_WWPN)) {
2486 		tmf->common.version = cpu_to_be32(2);
2487 		tmf->target_wwpn = cpu_to_be64(rport->port_name);
2488 	} else {
2489 		tmf->common.version = cpu_to_be32(1);
2490 	}
2491 	tmf->common.opcode = cpu_to_be32(IBMVFC_TMF_MAD);
2492 	tmf->common.length = cpu_to_be16(sizeof(*tmf));
2493 	tmf->scsi_id = cpu_to_be64(rport->port_id);
2494 	int_to_scsilun(sdev->lun, &tmf->lun);
2495 	if (!ibmvfc_check_caps(vhost, IBMVFC_CAN_SUPPRESS_ABTS))
2496 		type &= ~IBMVFC_TMF_SUPPRESS_ABTS;
2497 	if (vhost->state == IBMVFC_ACTIVE)
2498 		tmf->flags = cpu_to_be32((type | IBMVFC_TMF_LUA_VALID));
2499 	else
2500 		tmf->flags = cpu_to_be32(((type & IBMVFC_TMF_SUPPRESS_ABTS) | IBMVFC_TMF_LUA_VALID));
2501 	tmf->cancel_key = cpu_to_be32((unsigned long)sdev->hostdata);
2502 	tmf->my_cancel_key = cpu_to_be32((unsigned long)starget->hostdata);
2503 
2504 	init_completion(&evt->comp);
2505 
2506 	return evt;
2507 }
2508 
2509 static int ibmvfc_cancel_all_mq(struct scsi_device *sdev, int type)
2510 {
2511 	struct ibmvfc_host *vhost = shost_priv(sdev->host);
2512 	struct ibmvfc_event *evt, *found_evt, *temp;
2513 	struct ibmvfc_queue *queues = vhost->scsi_scrqs.scrqs;
2514 	unsigned long flags;
2515 	int num_hwq, i;
2516 	int fail = 0;
2517 	LIST_HEAD(cancelq);
2518 	u16 status;
2519 
2520 	ENTER;
2521 	spin_lock_irqsave(vhost->host->host_lock, flags);
2522 	num_hwq = vhost->scsi_scrqs.active_queues;
2523 	for (i = 0; i < num_hwq; i++) {
2524 		spin_lock(queues[i].q_lock);
2525 		spin_lock(&queues[i].l_lock);
2526 		found_evt = NULL;
2527 		list_for_each_entry(evt, &queues[i].sent, queue_list) {
2528 			if (evt->cmnd && evt->cmnd->device == sdev) {
2529 				found_evt = evt;
2530 				break;
2531 			}
2532 		}
2533 		spin_unlock(&queues[i].l_lock);
2534 
2535 		if (found_evt && vhost->logged_in) {
2536 			evt = ibmvfc_init_tmf(&queues[i], sdev, type);
2537 			evt->sync_iu = &queues[i].cancel_rsp;
2538 			ibmvfc_send_event(evt, vhost, default_timeout);
2539 			list_add_tail(&evt->cancel, &cancelq);
2540 		}
2541 
2542 		spin_unlock(queues[i].q_lock);
2543 	}
2544 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2545 
2546 	if (list_empty(&cancelq)) {
2547 		if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
2548 			sdev_printk(KERN_INFO, sdev, "No events found to cancel\n");
2549 		return 0;
2550 	}
2551 
2552 	sdev_printk(KERN_INFO, sdev, "Cancelling outstanding commands.\n");
2553 
2554 	list_for_each_entry_safe(evt, temp, &cancelq, cancel) {
2555 		wait_for_completion(&evt->comp);
2556 		status = be16_to_cpu(evt->queue->cancel_rsp.mad_common.status);
2557 		list_del(&evt->cancel);
2558 		ibmvfc_free_event(evt);
2559 
2560 		if (status != IBMVFC_MAD_SUCCESS) {
2561 			sdev_printk(KERN_WARNING, sdev, "Cancel failed with rc=%x\n", status);
2562 			switch (status) {
2563 			case IBMVFC_MAD_DRIVER_FAILED:
2564 			case IBMVFC_MAD_CRQ_ERROR:
2565 			/* Host adapter most likely going through reset, return success to
2566 			 * the caller will wait for the command being cancelled to get returned
2567 			 */
2568 				break;
2569 			default:
2570 				fail = 1;
2571 				break;
2572 			}
2573 		}
2574 	}
2575 
2576 	if (fail)
2577 		return -EIO;
2578 
2579 	sdev_printk(KERN_INFO, sdev, "Successfully cancelled outstanding commands\n");
2580 	LEAVE;
2581 	return 0;
2582 }
2583 
2584 static int ibmvfc_cancel_all_sq(struct scsi_device *sdev, int type)
2585 {
2586 	struct ibmvfc_host *vhost = shost_priv(sdev->host);
2587 	struct ibmvfc_event *evt, *found_evt;
2588 	union ibmvfc_iu rsp;
2589 	int rsp_rc = -EBUSY;
2590 	unsigned long flags;
2591 	u16 status;
2592 
2593 	ENTER;
2594 	found_evt = NULL;
2595 	spin_lock_irqsave(vhost->host->host_lock, flags);
2596 	spin_lock(&vhost->crq.l_lock);
2597 	list_for_each_entry(evt, &vhost->crq.sent, queue_list) {
2598 		if (evt->cmnd && evt->cmnd->device == sdev) {
2599 			found_evt = evt;
2600 			break;
2601 		}
2602 	}
2603 	spin_unlock(&vhost->crq.l_lock);
2604 
2605 	if (!found_evt) {
2606 		if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
2607 			sdev_printk(KERN_INFO, sdev, "No events found to cancel\n");
2608 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
2609 		return 0;
2610 	}
2611 
2612 	if (vhost->logged_in) {
2613 		evt = ibmvfc_init_tmf(&vhost->crq, sdev, type);
2614 		evt->sync_iu = &rsp;
2615 		rsp_rc = ibmvfc_send_event(evt, vhost, default_timeout);
2616 	}
2617 
2618 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2619 
2620 	if (rsp_rc != 0) {
2621 		sdev_printk(KERN_ERR, sdev, "Failed to send cancel event. rc=%d\n", rsp_rc);
2622 		/* If failure is received, the host adapter is most likely going
2623 		 through reset, return success so the caller will wait for the command
2624 		 being cancelled to get returned */
2625 		return 0;
2626 	}
2627 
2628 	sdev_printk(KERN_INFO, sdev, "Cancelling outstanding commands.\n");
2629 
2630 	wait_for_completion(&evt->comp);
2631 	status = be16_to_cpu(rsp.mad_common.status);
2632 	spin_lock_irqsave(vhost->host->host_lock, flags);
2633 	ibmvfc_free_event(evt);
2634 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2635 
2636 	if (status != IBMVFC_MAD_SUCCESS) {
2637 		sdev_printk(KERN_WARNING, sdev, "Cancel failed with rc=%x\n", status);
2638 		switch (status) {
2639 		case IBMVFC_MAD_DRIVER_FAILED:
2640 		case IBMVFC_MAD_CRQ_ERROR:
2641 			/* Host adapter most likely going through reset, return success to
2642 			 the caller will wait for the command being cancelled to get returned */
2643 			return 0;
2644 		default:
2645 			return -EIO;
2646 		};
2647 	}
2648 
2649 	sdev_printk(KERN_INFO, sdev, "Successfully cancelled outstanding commands\n");
2650 	return 0;
2651 }
2652 
2653 /**
2654  * ibmvfc_cancel_all - Cancel all outstanding commands to the device
2655  * @sdev:	scsi device to cancel commands
2656  * @type:	type of error recovery being performed
2657  *
2658  * This sends a cancel to the VIOS for the specified device. This does
2659  * NOT send any abort to the actual device. That must be done separately.
2660  *
2661  * Returns:
2662  *	0 on success / other on failure
2663  **/
2664 static int ibmvfc_cancel_all(struct scsi_device *sdev, int type)
2665 {
2666 	struct ibmvfc_host *vhost = shost_priv(sdev->host);
2667 
2668 	if (vhost->mq_enabled && vhost->using_channels)
2669 		return ibmvfc_cancel_all_mq(sdev, type);
2670 	else
2671 		return ibmvfc_cancel_all_sq(sdev, type);
2672 }
2673 
2674 /**
2675  * ibmvfc_match_key - Match function for specified cancel key
2676  * @evt:	ibmvfc event struct
2677  * @key:	cancel key to match
2678  *
2679  * Returns:
2680  *	1 if event matches key / 0 if event does not match key
2681  **/
2682 static int ibmvfc_match_key(struct ibmvfc_event *evt, void *key)
2683 {
2684 	unsigned long cancel_key = (unsigned long)key;
2685 
2686 	if (evt->crq.format == IBMVFC_CMD_FORMAT &&
2687 	    be32_to_cpu(evt->iu.cmd.cancel_key) == cancel_key)
2688 		return 1;
2689 	return 0;
2690 }
2691 
2692 /**
2693  * ibmvfc_match_evt - Match function for specified event
2694  * @evt:	ibmvfc event struct
2695  * @match:	event to match
2696  *
2697  * Returns:
2698  *	1 if event matches key / 0 if event does not match key
2699  **/
2700 static int ibmvfc_match_evt(struct ibmvfc_event *evt, void *match)
2701 {
2702 	if (evt == match)
2703 		return 1;
2704 	return 0;
2705 }
2706 
2707 /**
2708  * ibmvfc_abort_task_set - Abort outstanding commands to the device
2709  * @sdev:	scsi device to abort commands
2710  *
2711  * This sends an Abort Task Set to the VIOS for the specified device. This does
2712  * NOT send any cancel to the VIOS. That must be done separately.
2713  *
2714  * Returns:
2715  *	0 on success / other on failure
2716  **/
2717 static int ibmvfc_abort_task_set(struct scsi_device *sdev)
2718 {
2719 	struct ibmvfc_host *vhost = shost_priv(sdev->host);
2720 	struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
2721 	struct ibmvfc_cmd *tmf;
2722 	struct ibmvfc_event *evt, *found_evt;
2723 	union ibmvfc_iu rsp_iu;
2724 	struct ibmvfc_fcp_cmd_iu *iu;
2725 	struct ibmvfc_fcp_rsp *fc_rsp = ibmvfc_get_fcp_rsp(vhost, &rsp_iu.cmd);
2726 	int rc, rsp_rc = -EBUSY;
2727 	unsigned long flags, timeout = IBMVFC_ABORT_TIMEOUT;
2728 	int rsp_code = 0;
2729 
2730 	found_evt = NULL;
2731 	spin_lock_irqsave(vhost->host->host_lock, flags);
2732 	spin_lock(&vhost->crq.l_lock);
2733 	list_for_each_entry(evt, &vhost->crq.sent, queue_list) {
2734 		if (evt->cmnd && evt->cmnd->device == sdev) {
2735 			found_evt = evt;
2736 			break;
2737 		}
2738 	}
2739 	spin_unlock(&vhost->crq.l_lock);
2740 
2741 	if (!found_evt) {
2742 		if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
2743 			sdev_printk(KERN_INFO, sdev, "No events found to abort\n");
2744 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
2745 		return 0;
2746 	}
2747 
2748 	if (vhost->state == IBMVFC_ACTIVE) {
2749 		evt = ibmvfc_get_event(&vhost->crq);
2750 		ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_CMD_FORMAT);
2751 		tmf = ibmvfc_init_vfc_cmd(evt, sdev);
2752 		iu = ibmvfc_get_fcp_iu(vhost, tmf);
2753 
2754 		if (ibmvfc_check_caps(vhost, IBMVFC_HANDLE_VF_WWPN))
2755 			tmf->target_wwpn = cpu_to_be64(rport->port_name);
2756 		iu->tmf_flags = IBMVFC_ABORT_TASK_SET;
2757 		tmf->flags = cpu_to_be16((IBMVFC_NO_MEM_DESC | IBMVFC_TMF));
2758 		evt->sync_iu = &rsp_iu;
2759 
2760 		tmf->correlation = cpu_to_be64((u64)evt);
2761 
2762 		init_completion(&evt->comp);
2763 		rsp_rc = ibmvfc_send_event(evt, vhost, default_timeout);
2764 	}
2765 
2766 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2767 
2768 	if (rsp_rc != 0) {
2769 		sdev_printk(KERN_ERR, sdev, "Failed to send abort. rc=%d\n", rsp_rc);
2770 		return -EIO;
2771 	}
2772 
2773 	sdev_printk(KERN_INFO, sdev, "Aborting outstanding commands\n");
2774 	timeout = wait_for_completion_timeout(&evt->comp, timeout);
2775 
2776 	if (!timeout) {
2777 		rc = ibmvfc_cancel_all(sdev, 0);
2778 		if (!rc) {
2779 			rc = ibmvfc_wait_for_ops(vhost, sdev->hostdata, ibmvfc_match_key);
2780 			if (rc == SUCCESS)
2781 				rc = 0;
2782 		}
2783 
2784 		if (rc) {
2785 			sdev_printk(KERN_INFO, sdev, "Cancel failed, resetting host\n");
2786 			ibmvfc_reset_host(vhost);
2787 			rsp_rc = -EIO;
2788 			rc = ibmvfc_wait_for_ops(vhost, sdev->hostdata, ibmvfc_match_key);
2789 
2790 			if (rc == SUCCESS)
2791 				rsp_rc = 0;
2792 
2793 			rc = ibmvfc_wait_for_ops(vhost, evt, ibmvfc_match_evt);
2794 			if (rc != SUCCESS) {
2795 				spin_lock_irqsave(vhost->host->host_lock, flags);
2796 				ibmvfc_hard_reset_host(vhost);
2797 				spin_unlock_irqrestore(vhost->host->host_lock, flags);
2798 				rsp_rc = 0;
2799 			}
2800 
2801 			goto out;
2802 		}
2803 	}
2804 
2805 	if (rsp_iu.cmd.status)
2806 		rsp_code = ibmvfc_get_err_result(vhost, &rsp_iu.cmd);
2807 
2808 	if (rsp_code) {
2809 		if (fc_rsp->flags & FCP_RSP_LEN_VALID)
2810 			rsp_code = fc_rsp->data.info.rsp_code;
2811 
2812 		sdev_printk(KERN_ERR, sdev, "Abort failed: %s (%x:%x) "
2813 			    "flags: %x fcp_rsp: %x, scsi_status: %x\n",
2814 			    ibmvfc_get_cmd_error(be16_to_cpu(rsp_iu.cmd.status), be16_to_cpu(rsp_iu.cmd.error)),
2815 			    be16_to_cpu(rsp_iu.cmd.status), be16_to_cpu(rsp_iu.cmd.error), fc_rsp->flags, rsp_code,
2816 			    fc_rsp->scsi_status);
2817 		rsp_rc = -EIO;
2818 	} else
2819 		sdev_printk(KERN_INFO, sdev, "Abort successful\n");
2820 
2821 out:
2822 	spin_lock_irqsave(vhost->host->host_lock, flags);
2823 	ibmvfc_free_event(evt);
2824 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2825 	return rsp_rc;
2826 }
2827 
2828 /**
2829  * ibmvfc_eh_abort_handler - Abort a command
2830  * @cmd:	scsi command to abort
2831  *
2832  * Returns:
2833  *	SUCCESS / FAST_IO_FAIL / FAILED
2834  **/
2835 static int ibmvfc_eh_abort_handler(struct scsi_cmnd *cmd)
2836 {
2837 	struct scsi_device *sdev = cmd->device;
2838 	struct ibmvfc_host *vhost = shost_priv(sdev->host);
2839 	int cancel_rc, block_rc;
2840 	int rc = FAILED;
2841 
2842 	ENTER;
2843 	block_rc = fc_block_scsi_eh(cmd);
2844 	ibmvfc_wait_while_resetting(vhost);
2845 	if (block_rc != FAST_IO_FAIL) {
2846 		cancel_rc = ibmvfc_cancel_all(sdev, IBMVFC_TMF_ABORT_TASK_SET);
2847 		ibmvfc_abort_task_set(sdev);
2848 	} else
2849 		cancel_rc = ibmvfc_cancel_all(sdev, IBMVFC_TMF_SUPPRESS_ABTS);
2850 
2851 	if (!cancel_rc)
2852 		rc = ibmvfc_wait_for_ops(vhost, sdev, ibmvfc_match_lun);
2853 
2854 	if (block_rc == FAST_IO_FAIL && rc != FAILED)
2855 		rc = FAST_IO_FAIL;
2856 
2857 	LEAVE;
2858 	return rc;
2859 }
2860 
2861 /**
2862  * ibmvfc_eh_device_reset_handler - Reset a single LUN
2863  * @cmd:	scsi command struct
2864  *
2865  * Returns:
2866  *	SUCCESS / FAST_IO_FAIL / FAILED
2867  **/
2868 static int ibmvfc_eh_device_reset_handler(struct scsi_cmnd *cmd)
2869 {
2870 	struct scsi_device *sdev = cmd->device;
2871 	struct ibmvfc_host *vhost = shost_priv(sdev->host);
2872 	int cancel_rc, block_rc, reset_rc = 0;
2873 	int rc = FAILED;
2874 
2875 	ENTER;
2876 	block_rc = fc_block_scsi_eh(cmd);
2877 	ibmvfc_wait_while_resetting(vhost);
2878 	if (block_rc != FAST_IO_FAIL) {
2879 		cancel_rc = ibmvfc_cancel_all(sdev, IBMVFC_TMF_LUN_RESET);
2880 		reset_rc = ibmvfc_reset_device(sdev, IBMVFC_LUN_RESET, "LUN");
2881 	} else
2882 		cancel_rc = ibmvfc_cancel_all(sdev, IBMVFC_TMF_SUPPRESS_ABTS);
2883 
2884 	if (!cancel_rc && !reset_rc)
2885 		rc = ibmvfc_wait_for_ops(vhost, sdev, ibmvfc_match_lun);
2886 
2887 	if (block_rc == FAST_IO_FAIL && rc != FAILED)
2888 		rc = FAST_IO_FAIL;
2889 
2890 	LEAVE;
2891 	return rc;
2892 }
2893 
2894 /**
2895  * ibmvfc_dev_cancel_all_noreset - Device iterated cancel all function
2896  * @sdev:	scsi device struct
2897  * @data:	return code
2898  *
2899  **/
2900 static void ibmvfc_dev_cancel_all_noreset(struct scsi_device *sdev, void *data)
2901 {
2902 	unsigned long *rc = data;
2903 	*rc |= ibmvfc_cancel_all(sdev, IBMVFC_TMF_SUPPRESS_ABTS);
2904 }
2905 
2906 /**
2907  * ibmvfc_dev_cancel_all_reset - Device iterated cancel all function
2908  * @sdev:	scsi device struct
2909  * @data:	return code
2910  *
2911  **/
2912 static void ibmvfc_dev_cancel_all_reset(struct scsi_device *sdev, void *data)
2913 {
2914 	unsigned long *rc = data;
2915 	*rc |= ibmvfc_cancel_all(sdev, IBMVFC_TMF_TGT_RESET);
2916 }
2917 
2918 /**
2919  * ibmvfc_eh_target_reset_handler - Reset the target
2920  * @cmd:	scsi command struct
2921  *
2922  * Returns:
2923  *	SUCCESS / FAST_IO_FAIL / FAILED
2924  **/
2925 static int ibmvfc_eh_target_reset_handler(struct scsi_cmnd *cmd)
2926 {
2927 	struct scsi_device *sdev = cmd->device;
2928 	struct ibmvfc_host *vhost = shost_priv(sdev->host);
2929 	struct scsi_target *starget = scsi_target(sdev);
2930 	int block_rc;
2931 	int reset_rc = 0;
2932 	int rc = FAILED;
2933 	unsigned long cancel_rc = 0;
2934 
2935 	ENTER;
2936 	block_rc = fc_block_scsi_eh(cmd);
2937 	ibmvfc_wait_while_resetting(vhost);
2938 	if (block_rc != FAST_IO_FAIL) {
2939 		starget_for_each_device(starget, &cancel_rc, ibmvfc_dev_cancel_all_reset);
2940 		reset_rc = ibmvfc_reset_device(sdev, IBMVFC_TARGET_RESET, "target");
2941 	} else
2942 		starget_for_each_device(starget, &cancel_rc, ibmvfc_dev_cancel_all_noreset);
2943 
2944 	if (!cancel_rc && !reset_rc)
2945 		rc = ibmvfc_wait_for_ops(vhost, starget, ibmvfc_match_target);
2946 
2947 	if (block_rc == FAST_IO_FAIL && rc != FAILED)
2948 		rc = FAST_IO_FAIL;
2949 
2950 	LEAVE;
2951 	return rc;
2952 }
2953 
2954 /**
2955  * ibmvfc_eh_host_reset_handler - Reset the connection to the server
2956  * @cmd:	struct scsi_cmnd having problems
2957  *
2958  **/
2959 static int ibmvfc_eh_host_reset_handler(struct scsi_cmnd *cmd)
2960 {
2961 	int rc;
2962 	struct ibmvfc_host *vhost = shost_priv(cmd->device->host);
2963 
2964 	dev_err(vhost->dev, "Resetting connection due to error recovery\n");
2965 	rc = ibmvfc_issue_fc_host_lip(vhost->host);
2966 
2967 	return rc ? FAILED : SUCCESS;
2968 }
2969 
2970 /**
2971  * ibmvfc_terminate_rport_io - Terminate all pending I/O to the rport.
2972  * @rport:		rport struct
2973  *
2974  * Return value:
2975  * 	none
2976  **/
2977 static void ibmvfc_terminate_rport_io(struct fc_rport *rport)
2978 {
2979 	struct Scsi_Host *shost = rport_to_shost(rport);
2980 	struct ibmvfc_host *vhost = shost_priv(shost);
2981 	struct fc_rport *dev_rport;
2982 	struct scsi_device *sdev;
2983 	struct ibmvfc_target *tgt;
2984 	unsigned long rc, flags;
2985 	unsigned int found;
2986 
2987 	ENTER;
2988 	shost_for_each_device(sdev, shost) {
2989 		dev_rport = starget_to_rport(scsi_target(sdev));
2990 		if (dev_rport != rport)
2991 			continue;
2992 		ibmvfc_cancel_all(sdev, IBMVFC_TMF_SUPPRESS_ABTS);
2993 	}
2994 
2995 	rc = ibmvfc_wait_for_ops(vhost, rport, ibmvfc_match_rport);
2996 
2997 	if (rc == FAILED)
2998 		ibmvfc_issue_fc_host_lip(shost);
2999 
3000 	spin_lock_irqsave(shost->host_lock, flags);
3001 	found = 0;
3002 	list_for_each_entry(tgt, &vhost->targets, queue) {
3003 		if (tgt->scsi_id == rport->port_id) {
3004 			found++;
3005 			break;
3006 		}
3007 	}
3008 
3009 	if (found && tgt->action == IBMVFC_TGT_ACTION_LOGOUT_DELETED_RPORT) {
3010 		/*
3011 		 * If we get here, that means we previously attempted to send
3012 		 * an implicit logout to the target but it failed, most likely
3013 		 * due to I/O being pending, so we need to send it again
3014 		 */
3015 		ibmvfc_del_tgt(tgt);
3016 		ibmvfc_reinit_host(vhost);
3017 	}
3018 
3019 	spin_unlock_irqrestore(shost->host_lock, flags);
3020 	LEAVE;
3021 }
3022 
3023 static const struct ibmvfc_async_desc ae_desc [] = {
3024 	{ "PLOGI",	IBMVFC_AE_ELS_PLOGI,	IBMVFC_DEFAULT_LOG_LEVEL + 1 },
3025 	{ "LOGO",	IBMVFC_AE_ELS_LOGO,	IBMVFC_DEFAULT_LOG_LEVEL + 1 },
3026 	{ "PRLO",	IBMVFC_AE_ELS_PRLO,	IBMVFC_DEFAULT_LOG_LEVEL + 1 },
3027 	{ "N-Port SCN",	IBMVFC_AE_SCN_NPORT,	IBMVFC_DEFAULT_LOG_LEVEL + 1 },
3028 	{ "Group SCN",	IBMVFC_AE_SCN_GROUP,	IBMVFC_DEFAULT_LOG_LEVEL + 1 },
3029 	{ "Domain SCN",	IBMVFC_AE_SCN_DOMAIN,	IBMVFC_DEFAULT_LOG_LEVEL },
3030 	{ "Fabric SCN",	IBMVFC_AE_SCN_FABRIC,	IBMVFC_DEFAULT_LOG_LEVEL },
3031 	{ "Link Up",	IBMVFC_AE_LINK_UP,	IBMVFC_DEFAULT_LOG_LEVEL },
3032 	{ "Link Down",	IBMVFC_AE_LINK_DOWN,	IBMVFC_DEFAULT_LOG_LEVEL },
3033 	{ "Link Dead",	IBMVFC_AE_LINK_DEAD,	IBMVFC_DEFAULT_LOG_LEVEL },
3034 	{ "Halt",	IBMVFC_AE_HALT,		IBMVFC_DEFAULT_LOG_LEVEL },
3035 	{ "Resume",	IBMVFC_AE_RESUME,	IBMVFC_DEFAULT_LOG_LEVEL },
3036 	{ "Adapter Failed", IBMVFC_AE_ADAPTER_FAILED, IBMVFC_DEFAULT_LOG_LEVEL },
3037 };
3038 
3039 static const struct ibmvfc_async_desc unknown_ae = {
3040 	"Unknown async", 0, IBMVFC_DEFAULT_LOG_LEVEL
3041 };
3042 
3043 /**
3044  * ibmvfc_get_ae_desc - Get text description for async event
3045  * @ae:	async event
3046  *
3047  **/
3048 static const struct ibmvfc_async_desc *ibmvfc_get_ae_desc(u64 ae)
3049 {
3050 	int i;
3051 
3052 	for (i = 0; i < ARRAY_SIZE(ae_desc); i++)
3053 		if (ae_desc[i].ae == ae)
3054 			return &ae_desc[i];
3055 
3056 	return &unknown_ae;
3057 }
3058 
3059 static const struct {
3060 	enum ibmvfc_ae_link_state state;
3061 	const char *desc;
3062 } link_desc [] = {
3063 	{ IBMVFC_AE_LS_LINK_UP,		" link up" },
3064 	{ IBMVFC_AE_LS_LINK_BOUNCED,	" link bounced" },
3065 	{ IBMVFC_AE_LS_LINK_DOWN,	" link down" },
3066 	{ IBMVFC_AE_LS_LINK_DEAD,	" link dead" },
3067 };
3068 
3069 /**
3070  * ibmvfc_get_link_state - Get text description for link state
3071  * @state:	link state
3072  *
3073  **/
3074 static const char *ibmvfc_get_link_state(enum ibmvfc_ae_link_state state)
3075 {
3076 	int i;
3077 
3078 	for (i = 0; i < ARRAY_SIZE(link_desc); i++)
3079 		if (link_desc[i].state == state)
3080 			return link_desc[i].desc;
3081 
3082 	return "";
3083 }
3084 
3085 /**
3086  * ibmvfc_handle_async - Handle an async event from the adapter
3087  * @crq:	crq to process
3088  * @vhost:	ibmvfc host struct
3089  *
3090  **/
3091 static void ibmvfc_handle_async(struct ibmvfc_async_crq *crq,
3092 				struct ibmvfc_host *vhost)
3093 {
3094 	const struct ibmvfc_async_desc *desc = ibmvfc_get_ae_desc(be64_to_cpu(crq->event));
3095 	struct ibmvfc_target *tgt;
3096 
3097 	ibmvfc_log(vhost, desc->log_level, "%s event received. scsi_id: %llx, wwpn: %llx,"
3098 		   " node_name: %llx%s\n", desc->desc, be64_to_cpu(crq->scsi_id),
3099 		   be64_to_cpu(crq->wwpn), be64_to_cpu(crq->node_name),
3100 		   ibmvfc_get_link_state(crq->link_state));
3101 
3102 	switch (be64_to_cpu(crq->event)) {
3103 	case IBMVFC_AE_RESUME:
3104 		switch (crq->link_state) {
3105 		case IBMVFC_AE_LS_LINK_DOWN:
3106 			ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
3107 			break;
3108 		case IBMVFC_AE_LS_LINK_DEAD:
3109 			ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3110 			break;
3111 		case IBMVFC_AE_LS_LINK_UP:
3112 		case IBMVFC_AE_LS_LINK_BOUNCED:
3113 		default:
3114 			vhost->events_to_log |= IBMVFC_AE_LINKUP;
3115 			vhost->delay_init = 1;
3116 			__ibmvfc_reset_host(vhost);
3117 			break;
3118 		}
3119 
3120 		break;
3121 	case IBMVFC_AE_LINK_UP:
3122 		vhost->events_to_log |= IBMVFC_AE_LINKUP;
3123 		vhost->delay_init = 1;
3124 		__ibmvfc_reset_host(vhost);
3125 		break;
3126 	case IBMVFC_AE_SCN_FABRIC:
3127 	case IBMVFC_AE_SCN_DOMAIN:
3128 		vhost->events_to_log |= IBMVFC_AE_RSCN;
3129 		if (vhost->state < IBMVFC_HALTED) {
3130 			vhost->delay_init = 1;
3131 			__ibmvfc_reset_host(vhost);
3132 		}
3133 		break;
3134 	case IBMVFC_AE_SCN_NPORT:
3135 	case IBMVFC_AE_SCN_GROUP:
3136 		vhost->events_to_log |= IBMVFC_AE_RSCN;
3137 		ibmvfc_reinit_host(vhost);
3138 		break;
3139 	case IBMVFC_AE_ELS_LOGO:
3140 	case IBMVFC_AE_ELS_PRLO:
3141 	case IBMVFC_AE_ELS_PLOGI:
3142 		list_for_each_entry(tgt, &vhost->targets, queue) {
3143 			if (!crq->scsi_id && !crq->wwpn && !crq->node_name)
3144 				break;
3145 			if (crq->scsi_id && cpu_to_be64(tgt->scsi_id) != crq->scsi_id)
3146 				continue;
3147 			if (crq->wwpn && cpu_to_be64(tgt->ids.port_name) != crq->wwpn)
3148 				continue;
3149 			if (crq->node_name && cpu_to_be64(tgt->ids.node_name) != crq->node_name)
3150 				continue;
3151 			if (tgt->need_login && be64_to_cpu(crq->event) == IBMVFC_AE_ELS_LOGO)
3152 				tgt->logo_rcvd = 1;
3153 			if (!tgt->need_login || be64_to_cpu(crq->event) == IBMVFC_AE_ELS_PLOGI) {
3154 				ibmvfc_del_tgt(tgt);
3155 				ibmvfc_reinit_host(vhost);
3156 			}
3157 		}
3158 		break;
3159 	case IBMVFC_AE_LINK_DOWN:
3160 	case IBMVFC_AE_ADAPTER_FAILED:
3161 		ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
3162 		break;
3163 	case IBMVFC_AE_LINK_DEAD:
3164 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3165 		break;
3166 	case IBMVFC_AE_HALT:
3167 		ibmvfc_link_down(vhost, IBMVFC_HALTED);
3168 		break;
3169 	default:
3170 		dev_err(vhost->dev, "Unknown async event received: %lld\n", crq->event);
3171 		break;
3172 	}
3173 }
3174 
3175 /**
3176  * ibmvfc_handle_crq - Handles and frees received events in the CRQ
3177  * @crq:	Command/Response queue
3178  * @vhost:	ibmvfc host struct
3179  *
3180  **/
3181 static void ibmvfc_handle_crq(struct ibmvfc_crq *crq, struct ibmvfc_host *vhost,
3182 			      struct list_head *evt_doneq)
3183 {
3184 	long rc;
3185 	struct ibmvfc_event *evt = (struct ibmvfc_event *)be64_to_cpu(crq->ioba);
3186 
3187 	switch (crq->valid) {
3188 	case IBMVFC_CRQ_INIT_RSP:
3189 		switch (crq->format) {
3190 		case IBMVFC_CRQ_INIT:
3191 			dev_info(vhost->dev, "Partner initialized\n");
3192 			/* Send back a response */
3193 			rc = ibmvfc_send_crq_init_complete(vhost);
3194 			if (rc == 0)
3195 				ibmvfc_init_host(vhost);
3196 			else
3197 				dev_err(vhost->dev, "Unable to send init rsp. rc=%ld\n", rc);
3198 			break;
3199 		case IBMVFC_CRQ_INIT_COMPLETE:
3200 			dev_info(vhost->dev, "Partner initialization complete\n");
3201 			ibmvfc_init_host(vhost);
3202 			break;
3203 		default:
3204 			dev_err(vhost->dev, "Unknown crq message type: %d\n", crq->format);
3205 		}
3206 		return;
3207 	case IBMVFC_CRQ_XPORT_EVENT:
3208 		vhost->state = IBMVFC_NO_CRQ;
3209 		vhost->logged_in = 0;
3210 		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_NONE);
3211 		if (crq->format == IBMVFC_PARTITION_MIGRATED) {
3212 			/* We need to re-setup the interpartition connection */
3213 			dev_info(vhost->dev, "Partition migrated, Re-enabling adapter\n");
3214 			vhost->client_migrated = 1;
3215 			ibmvfc_purge_requests(vhost, DID_REQUEUE);
3216 			ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
3217 			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_REENABLE);
3218 		} else if (crq->format == IBMVFC_PARTNER_FAILED || crq->format == IBMVFC_PARTNER_DEREGISTER) {
3219 			dev_err(vhost->dev, "Host partner adapter deregistered or failed (rc=%d)\n", crq->format);
3220 			ibmvfc_purge_requests(vhost, DID_ERROR);
3221 			ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
3222 			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_RESET);
3223 		} else {
3224 			dev_err(vhost->dev, "Received unknown transport event from partner (rc=%d)\n", crq->format);
3225 		}
3226 		return;
3227 	case IBMVFC_CRQ_CMD_RSP:
3228 		break;
3229 	default:
3230 		dev_err(vhost->dev, "Got an invalid message type 0x%02x\n", crq->valid);
3231 		return;
3232 	}
3233 
3234 	if (crq->format == IBMVFC_ASYNC_EVENT)
3235 		return;
3236 
3237 	/* The only kind of payload CRQs we should get are responses to
3238 	 * things we send. Make sure this response is to something we
3239 	 * actually sent
3240 	 */
3241 	if (unlikely(!ibmvfc_valid_event(&vhost->crq.evt_pool, evt))) {
3242 		dev_err(vhost->dev, "Returned correlation_token 0x%08llx is invalid!\n",
3243 			crq->ioba);
3244 		return;
3245 	}
3246 
3247 	if (unlikely(atomic_read(&evt->free))) {
3248 		dev_err(vhost->dev, "Received duplicate correlation_token 0x%08llx!\n",
3249 			crq->ioba);
3250 		return;
3251 	}
3252 
3253 	spin_lock(&evt->queue->l_lock);
3254 	list_move_tail(&evt->queue_list, evt_doneq);
3255 	spin_unlock(&evt->queue->l_lock);
3256 }
3257 
3258 /**
3259  * ibmvfc_scan_finished - Check if the device scan is done.
3260  * @shost:	scsi host struct
3261  * @time:	current elapsed time
3262  *
3263  * Returns:
3264  *	0 if scan is not done / 1 if scan is done
3265  **/
3266 static int ibmvfc_scan_finished(struct Scsi_Host *shost, unsigned long time)
3267 {
3268 	unsigned long flags;
3269 	struct ibmvfc_host *vhost = shost_priv(shost);
3270 	int done = 0;
3271 
3272 	spin_lock_irqsave(shost->host_lock, flags);
3273 	if (time >= (init_timeout * HZ)) {
3274 		dev_info(vhost->dev, "Scan taking longer than %d seconds, "
3275 			 "continuing initialization\n", init_timeout);
3276 		done = 1;
3277 	}
3278 
3279 	if (vhost->scan_complete)
3280 		done = 1;
3281 	spin_unlock_irqrestore(shost->host_lock, flags);
3282 	return done;
3283 }
3284 
3285 /**
3286  * ibmvfc_slave_alloc - Setup the device's task set value
3287  * @sdev:	struct scsi_device device to configure
3288  *
3289  * Set the device's task set value so that error handling works as
3290  * expected.
3291  *
3292  * Returns:
3293  *	0 on success / -ENXIO if device does not exist
3294  **/
3295 static int ibmvfc_slave_alloc(struct scsi_device *sdev)
3296 {
3297 	struct Scsi_Host *shost = sdev->host;
3298 	struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
3299 	struct ibmvfc_host *vhost = shost_priv(shost);
3300 	unsigned long flags = 0;
3301 
3302 	if (!rport || fc_remote_port_chkready(rport))
3303 		return -ENXIO;
3304 
3305 	spin_lock_irqsave(shost->host_lock, flags);
3306 	sdev->hostdata = (void *)(unsigned long)vhost->task_set++;
3307 	spin_unlock_irqrestore(shost->host_lock, flags);
3308 	return 0;
3309 }
3310 
3311 /**
3312  * ibmvfc_target_alloc - Setup the target's task set value
3313  * @starget:	struct scsi_target
3314  *
3315  * Set the target's task set value so that error handling works as
3316  * expected.
3317  *
3318  * Returns:
3319  *	0 on success / -ENXIO if device does not exist
3320  **/
3321 static int ibmvfc_target_alloc(struct scsi_target *starget)
3322 {
3323 	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
3324 	struct ibmvfc_host *vhost = shost_priv(shost);
3325 	unsigned long flags = 0;
3326 
3327 	spin_lock_irqsave(shost->host_lock, flags);
3328 	starget->hostdata = (void *)(unsigned long)vhost->task_set++;
3329 	spin_unlock_irqrestore(shost->host_lock, flags);
3330 	return 0;
3331 }
3332 
3333 /**
3334  * ibmvfc_slave_configure - Configure the device
3335  * @sdev:	struct scsi_device device to configure
3336  *
3337  * Enable allow_restart for a device if it is a disk. Adjust the
3338  * queue_depth here also.
3339  *
3340  * Returns:
3341  *	0
3342  **/
3343 static int ibmvfc_slave_configure(struct scsi_device *sdev)
3344 {
3345 	struct Scsi_Host *shost = sdev->host;
3346 	unsigned long flags = 0;
3347 
3348 	spin_lock_irqsave(shost->host_lock, flags);
3349 	if (sdev->type == TYPE_DISK) {
3350 		sdev->allow_restart = 1;
3351 		blk_queue_rq_timeout(sdev->request_queue, 120 * HZ);
3352 	}
3353 	spin_unlock_irqrestore(shost->host_lock, flags);
3354 	return 0;
3355 }
3356 
3357 /**
3358  * ibmvfc_change_queue_depth - Change the device's queue depth
3359  * @sdev:	scsi device struct
3360  * @qdepth:	depth to set
3361  * @reason:	calling context
3362  *
3363  * Return value:
3364  * 	actual depth set
3365  **/
3366 static int ibmvfc_change_queue_depth(struct scsi_device *sdev, int qdepth)
3367 {
3368 	if (qdepth > IBMVFC_MAX_CMDS_PER_LUN)
3369 		qdepth = IBMVFC_MAX_CMDS_PER_LUN;
3370 
3371 	return scsi_change_queue_depth(sdev, qdepth);
3372 }
3373 
3374 static ssize_t ibmvfc_show_host_partition_name(struct device *dev,
3375 						 struct device_attribute *attr, char *buf)
3376 {
3377 	struct Scsi_Host *shost = class_to_shost(dev);
3378 	struct ibmvfc_host *vhost = shost_priv(shost);
3379 
3380 	return snprintf(buf, PAGE_SIZE, "%s\n",
3381 			vhost->login_buf->resp.partition_name);
3382 }
3383 
3384 static ssize_t ibmvfc_show_host_device_name(struct device *dev,
3385 					    struct device_attribute *attr, char *buf)
3386 {
3387 	struct Scsi_Host *shost = class_to_shost(dev);
3388 	struct ibmvfc_host *vhost = shost_priv(shost);
3389 
3390 	return snprintf(buf, PAGE_SIZE, "%s\n",
3391 			vhost->login_buf->resp.device_name);
3392 }
3393 
3394 static ssize_t ibmvfc_show_host_loc_code(struct device *dev,
3395 					 struct device_attribute *attr, char *buf)
3396 {
3397 	struct Scsi_Host *shost = class_to_shost(dev);
3398 	struct ibmvfc_host *vhost = shost_priv(shost);
3399 
3400 	return snprintf(buf, PAGE_SIZE, "%s\n",
3401 			vhost->login_buf->resp.port_loc_code);
3402 }
3403 
3404 static ssize_t ibmvfc_show_host_drc_name(struct device *dev,
3405 					 struct device_attribute *attr, char *buf)
3406 {
3407 	struct Scsi_Host *shost = class_to_shost(dev);
3408 	struct ibmvfc_host *vhost = shost_priv(shost);
3409 
3410 	return snprintf(buf, PAGE_SIZE, "%s\n",
3411 			vhost->login_buf->resp.drc_name);
3412 }
3413 
3414 static ssize_t ibmvfc_show_host_npiv_version(struct device *dev,
3415 					     struct device_attribute *attr, char *buf)
3416 {
3417 	struct Scsi_Host *shost = class_to_shost(dev);
3418 	struct ibmvfc_host *vhost = shost_priv(shost);
3419 	return snprintf(buf, PAGE_SIZE, "%d\n", be32_to_cpu(vhost->login_buf->resp.version));
3420 }
3421 
3422 static ssize_t ibmvfc_show_host_capabilities(struct device *dev,
3423 					     struct device_attribute *attr, char *buf)
3424 {
3425 	struct Scsi_Host *shost = class_to_shost(dev);
3426 	struct ibmvfc_host *vhost = shost_priv(shost);
3427 	return snprintf(buf, PAGE_SIZE, "%llx\n", be64_to_cpu(vhost->login_buf->resp.capabilities));
3428 }
3429 
3430 /**
3431  * ibmvfc_show_log_level - Show the adapter's error logging level
3432  * @dev:	class device struct
3433  * @buf:	buffer
3434  *
3435  * Return value:
3436  * 	number of bytes printed to buffer
3437  **/
3438 static ssize_t ibmvfc_show_log_level(struct device *dev,
3439 				     struct device_attribute *attr, char *buf)
3440 {
3441 	struct Scsi_Host *shost = class_to_shost(dev);
3442 	struct ibmvfc_host *vhost = shost_priv(shost);
3443 	unsigned long flags = 0;
3444 	int len;
3445 
3446 	spin_lock_irqsave(shost->host_lock, flags);
3447 	len = snprintf(buf, PAGE_SIZE, "%d\n", vhost->log_level);
3448 	spin_unlock_irqrestore(shost->host_lock, flags);
3449 	return len;
3450 }
3451 
3452 /**
3453  * ibmvfc_store_log_level - Change the adapter's error logging level
3454  * @dev:	class device struct
3455  * @buf:	buffer
3456  *
3457  * Return value:
3458  * 	number of bytes printed to buffer
3459  **/
3460 static ssize_t ibmvfc_store_log_level(struct device *dev,
3461 				      struct device_attribute *attr,
3462 				      const char *buf, size_t count)
3463 {
3464 	struct Scsi_Host *shost = class_to_shost(dev);
3465 	struct ibmvfc_host *vhost = shost_priv(shost);
3466 	unsigned long flags = 0;
3467 
3468 	spin_lock_irqsave(shost->host_lock, flags);
3469 	vhost->log_level = simple_strtoul(buf, NULL, 10);
3470 	spin_unlock_irqrestore(shost->host_lock, flags);
3471 	return strlen(buf);
3472 }
3473 
3474 static ssize_t ibmvfc_show_scsi_channels(struct device *dev,
3475 					 struct device_attribute *attr, char *buf)
3476 {
3477 	struct Scsi_Host *shost = class_to_shost(dev);
3478 	struct ibmvfc_host *vhost = shost_priv(shost);
3479 	unsigned long flags = 0;
3480 	int len;
3481 
3482 	spin_lock_irqsave(shost->host_lock, flags);
3483 	len = snprintf(buf, PAGE_SIZE, "%d\n", vhost->client_scsi_channels);
3484 	spin_unlock_irqrestore(shost->host_lock, flags);
3485 	return len;
3486 }
3487 
3488 static ssize_t ibmvfc_store_scsi_channels(struct device *dev,
3489 					 struct device_attribute *attr,
3490 					 const char *buf, size_t count)
3491 {
3492 	struct Scsi_Host *shost = class_to_shost(dev);
3493 	struct ibmvfc_host *vhost = shost_priv(shost);
3494 	unsigned long flags = 0;
3495 	unsigned int channels;
3496 
3497 	spin_lock_irqsave(shost->host_lock, flags);
3498 	channels = simple_strtoul(buf, NULL, 10);
3499 	vhost->client_scsi_channels = min(channels, nr_scsi_hw_queues);
3500 	ibmvfc_hard_reset_host(vhost);
3501 	spin_unlock_irqrestore(shost->host_lock, flags);
3502 	return strlen(buf);
3503 }
3504 
3505 static DEVICE_ATTR(partition_name, S_IRUGO, ibmvfc_show_host_partition_name, NULL);
3506 static DEVICE_ATTR(device_name, S_IRUGO, ibmvfc_show_host_device_name, NULL);
3507 static DEVICE_ATTR(port_loc_code, S_IRUGO, ibmvfc_show_host_loc_code, NULL);
3508 static DEVICE_ATTR(drc_name, S_IRUGO, ibmvfc_show_host_drc_name, NULL);
3509 static DEVICE_ATTR(npiv_version, S_IRUGO, ibmvfc_show_host_npiv_version, NULL);
3510 static DEVICE_ATTR(capabilities, S_IRUGO, ibmvfc_show_host_capabilities, NULL);
3511 static DEVICE_ATTR(log_level, S_IRUGO | S_IWUSR,
3512 		   ibmvfc_show_log_level, ibmvfc_store_log_level);
3513 static DEVICE_ATTR(nr_scsi_channels, S_IRUGO | S_IWUSR,
3514 		   ibmvfc_show_scsi_channels, ibmvfc_store_scsi_channels);
3515 
3516 #ifdef CONFIG_SCSI_IBMVFC_TRACE
3517 /**
3518  * ibmvfc_read_trace - Dump the adapter trace
3519  * @filp:		open sysfs file
3520  * @kobj:		kobject struct
3521  * @bin_attr:	bin_attribute struct
3522  * @buf:		buffer
3523  * @off:		offset
3524  * @count:		buffer size
3525  *
3526  * Return value:
3527  *	number of bytes printed to buffer
3528  **/
3529 static ssize_t ibmvfc_read_trace(struct file *filp, struct kobject *kobj,
3530 				 struct bin_attribute *bin_attr,
3531 				 char *buf, loff_t off, size_t count)
3532 {
3533 	struct device *dev = container_of(kobj, struct device, kobj);
3534 	struct Scsi_Host *shost = class_to_shost(dev);
3535 	struct ibmvfc_host *vhost = shost_priv(shost);
3536 	unsigned long flags = 0;
3537 	int size = IBMVFC_TRACE_SIZE;
3538 	char *src = (char *)vhost->trace;
3539 
3540 	if (off > size)
3541 		return 0;
3542 	if (off + count > size) {
3543 		size -= off;
3544 		count = size;
3545 	}
3546 
3547 	spin_lock_irqsave(shost->host_lock, flags);
3548 	memcpy(buf, &src[off], count);
3549 	spin_unlock_irqrestore(shost->host_lock, flags);
3550 	return count;
3551 }
3552 
3553 static struct bin_attribute ibmvfc_trace_attr = {
3554 	.attr =	{
3555 		.name = "trace",
3556 		.mode = S_IRUGO,
3557 	},
3558 	.size = 0,
3559 	.read = ibmvfc_read_trace,
3560 };
3561 #endif
3562 
3563 static struct device_attribute *ibmvfc_attrs[] = {
3564 	&dev_attr_partition_name,
3565 	&dev_attr_device_name,
3566 	&dev_attr_port_loc_code,
3567 	&dev_attr_drc_name,
3568 	&dev_attr_npiv_version,
3569 	&dev_attr_capabilities,
3570 	&dev_attr_log_level,
3571 	&dev_attr_nr_scsi_channels,
3572 	NULL
3573 };
3574 
3575 static struct scsi_host_template driver_template = {
3576 	.module = THIS_MODULE,
3577 	.name = "IBM POWER Virtual FC Adapter",
3578 	.proc_name = IBMVFC_NAME,
3579 	.queuecommand = ibmvfc_queuecommand,
3580 	.eh_timed_out = fc_eh_timed_out,
3581 	.eh_abort_handler = ibmvfc_eh_abort_handler,
3582 	.eh_device_reset_handler = ibmvfc_eh_device_reset_handler,
3583 	.eh_target_reset_handler = ibmvfc_eh_target_reset_handler,
3584 	.eh_host_reset_handler = ibmvfc_eh_host_reset_handler,
3585 	.slave_alloc = ibmvfc_slave_alloc,
3586 	.slave_configure = ibmvfc_slave_configure,
3587 	.target_alloc = ibmvfc_target_alloc,
3588 	.scan_finished = ibmvfc_scan_finished,
3589 	.change_queue_depth = ibmvfc_change_queue_depth,
3590 	.cmd_per_lun = 16,
3591 	.can_queue = IBMVFC_MAX_REQUESTS_DEFAULT,
3592 	.this_id = -1,
3593 	.sg_tablesize = SG_ALL,
3594 	.max_sectors = IBMVFC_MAX_SECTORS,
3595 	.shost_attrs = ibmvfc_attrs,
3596 	.track_queue_depth = 1,
3597 	.host_tagset = 1,
3598 };
3599 
3600 /**
3601  * ibmvfc_next_async_crq - Returns the next entry in async queue
3602  * @vhost:	ibmvfc host struct
3603  *
3604  * Returns:
3605  *	Pointer to next entry in queue / NULL if empty
3606  **/
3607 static struct ibmvfc_async_crq *ibmvfc_next_async_crq(struct ibmvfc_host *vhost)
3608 {
3609 	struct ibmvfc_queue *async_crq = &vhost->async_crq;
3610 	struct ibmvfc_async_crq *crq;
3611 
3612 	crq = &async_crq->msgs.async[async_crq->cur];
3613 	if (crq->valid & 0x80) {
3614 		if (++async_crq->cur == async_crq->size)
3615 			async_crq->cur = 0;
3616 		rmb();
3617 	} else
3618 		crq = NULL;
3619 
3620 	return crq;
3621 }
3622 
3623 /**
3624  * ibmvfc_next_crq - Returns the next entry in message queue
3625  * @vhost:	ibmvfc host struct
3626  *
3627  * Returns:
3628  *	Pointer to next entry in queue / NULL if empty
3629  **/
3630 static struct ibmvfc_crq *ibmvfc_next_crq(struct ibmvfc_host *vhost)
3631 {
3632 	struct ibmvfc_queue *queue = &vhost->crq;
3633 	struct ibmvfc_crq *crq;
3634 
3635 	crq = &queue->msgs.crq[queue->cur];
3636 	if (crq->valid & 0x80) {
3637 		if (++queue->cur == queue->size)
3638 			queue->cur = 0;
3639 		rmb();
3640 	} else
3641 		crq = NULL;
3642 
3643 	return crq;
3644 }
3645 
3646 /**
3647  * ibmvfc_interrupt - Interrupt handler
3648  * @irq:		number of irq to handle, not used
3649  * @dev_instance: ibmvfc_host that received interrupt
3650  *
3651  * Returns:
3652  *	IRQ_HANDLED
3653  **/
3654 static irqreturn_t ibmvfc_interrupt(int irq, void *dev_instance)
3655 {
3656 	struct ibmvfc_host *vhost = (struct ibmvfc_host *)dev_instance;
3657 	unsigned long flags;
3658 
3659 	spin_lock_irqsave(vhost->host->host_lock, flags);
3660 	vio_disable_interrupts(to_vio_dev(vhost->dev));
3661 	tasklet_schedule(&vhost->tasklet);
3662 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
3663 	return IRQ_HANDLED;
3664 }
3665 
3666 /**
3667  * ibmvfc_tasklet - Interrupt handler tasklet
3668  * @data:		ibmvfc host struct
3669  *
3670  * Returns:
3671  *	Nothing
3672  **/
3673 static void ibmvfc_tasklet(void *data)
3674 {
3675 	struct ibmvfc_host *vhost = data;
3676 	struct vio_dev *vdev = to_vio_dev(vhost->dev);
3677 	struct ibmvfc_crq *crq;
3678 	struct ibmvfc_async_crq *async;
3679 	struct ibmvfc_event *evt, *temp;
3680 	unsigned long flags;
3681 	int done = 0;
3682 	LIST_HEAD(evt_doneq);
3683 
3684 	spin_lock_irqsave(vhost->host->host_lock, flags);
3685 	spin_lock(vhost->crq.q_lock);
3686 	while (!done) {
3687 		/* Pull all the valid messages off the async CRQ */
3688 		while ((async = ibmvfc_next_async_crq(vhost)) != NULL) {
3689 			ibmvfc_handle_async(async, vhost);
3690 			async->valid = 0;
3691 			wmb();
3692 		}
3693 
3694 		/* Pull all the valid messages off the CRQ */
3695 		while ((crq = ibmvfc_next_crq(vhost)) != NULL) {
3696 			ibmvfc_handle_crq(crq, vhost, &evt_doneq);
3697 			crq->valid = 0;
3698 			wmb();
3699 		}
3700 
3701 		vio_enable_interrupts(vdev);
3702 		if ((async = ibmvfc_next_async_crq(vhost)) != NULL) {
3703 			vio_disable_interrupts(vdev);
3704 			ibmvfc_handle_async(async, vhost);
3705 			async->valid = 0;
3706 			wmb();
3707 		} else if ((crq = ibmvfc_next_crq(vhost)) != NULL) {
3708 			vio_disable_interrupts(vdev);
3709 			ibmvfc_handle_crq(crq, vhost, &evt_doneq);
3710 			crq->valid = 0;
3711 			wmb();
3712 		} else
3713 			done = 1;
3714 	}
3715 
3716 	spin_unlock(vhost->crq.q_lock);
3717 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
3718 
3719 	list_for_each_entry_safe(evt, temp, &evt_doneq, queue_list) {
3720 		del_timer(&evt->timer);
3721 		list_del(&evt->queue_list);
3722 		ibmvfc_trc_end(evt);
3723 		evt->done(evt);
3724 	}
3725 }
3726 
3727 static int ibmvfc_toggle_scrq_irq(struct ibmvfc_queue *scrq, int enable)
3728 {
3729 	struct device *dev = scrq->vhost->dev;
3730 	struct vio_dev *vdev = to_vio_dev(dev);
3731 	unsigned long rc;
3732 	int irq_action = H_ENABLE_VIO_INTERRUPT;
3733 
3734 	if (!enable)
3735 		irq_action = H_DISABLE_VIO_INTERRUPT;
3736 
3737 	rc = plpar_hcall_norets(H_VIOCTL, vdev->unit_address, irq_action,
3738 				scrq->hw_irq, 0, 0);
3739 
3740 	if (rc)
3741 		dev_err(dev, "Couldn't %s sub-crq[%lu] irq. rc=%ld\n",
3742 			enable ? "enable" : "disable", scrq->hwq_id, rc);
3743 
3744 	return rc;
3745 }
3746 
3747 static void ibmvfc_handle_scrq(struct ibmvfc_crq *crq, struct ibmvfc_host *vhost,
3748 			       struct list_head *evt_doneq)
3749 {
3750 	struct ibmvfc_event *evt = (struct ibmvfc_event *)be64_to_cpu(crq->ioba);
3751 
3752 	switch (crq->valid) {
3753 	case IBMVFC_CRQ_CMD_RSP:
3754 		break;
3755 	case IBMVFC_CRQ_XPORT_EVENT:
3756 		return;
3757 	default:
3758 		dev_err(vhost->dev, "Got and invalid message type 0x%02x\n", crq->valid);
3759 		return;
3760 	}
3761 
3762 	/* The only kind of payload CRQs we should get are responses to
3763 	 * things we send. Make sure this response is to something we
3764 	 * actually sent
3765 	 */
3766 	if (unlikely(!ibmvfc_valid_event(&evt->queue->evt_pool, evt))) {
3767 		dev_err(vhost->dev, "Returned correlation_token 0x%08llx is invalid!\n",
3768 			crq->ioba);
3769 		return;
3770 	}
3771 
3772 	if (unlikely(atomic_read(&evt->free))) {
3773 		dev_err(vhost->dev, "Received duplicate correlation_token 0x%08llx!\n",
3774 			crq->ioba);
3775 		return;
3776 	}
3777 
3778 	spin_lock(&evt->queue->l_lock);
3779 	list_move_tail(&evt->queue_list, evt_doneq);
3780 	spin_unlock(&evt->queue->l_lock);
3781 }
3782 
3783 static struct ibmvfc_crq *ibmvfc_next_scrq(struct ibmvfc_queue *scrq)
3784 {
3785 	struct ibmvfc_crq *crq;
3786 
3787 	crq = &scrq->msgs.scrq[scrq->cur].crq;
3788 	if (crq->valid & 0x80) {
3789 		if (++scrq->cur == scrq->size)
3790 			scrq->cur = 0;
3791 		rmb();
3792 	} else
3793 		crq = NULL;
3794 
3795 	return crq;
3796 }
3797 
3798 static void ibmvfc_drain_sub_crq(struct ibmvfc_queue *scrq)
3799 {
3800 	struct ibmvfc_crq *crq;
3801 	struct ibmvfc_event *evt, *temp;
3802 	unsigned long flags;
3803 	int done = 0;
3804 	LIST_HEAD(evt_doneq);
3805 
3806 	spin_lock_irqsave(scrq->q_lock, flags);
3807 	while (!done) {
3808 		while ((crq = ibmvfc_next_scrq(scrq)) != NULL) {
3809 			ibmvfc_handle_scrq(crq, scrq->vhost, &evt_doneq);
3810 			crq->valid = 0;
3811 			wmb();
3812 		}
3813 
3814 		ibmvfc_toggle_scrq_irq(scrq, 1);
3815 		if ((crq = ibmvfc_next_scrq(scrq)) != NULL) {
3816 			ibmvfc_toggle_scrq_irq(scrq, 0);
3817 			ibmvfc_handle_scrq(crq, scrq->vhost, &evt_doneq);
3818 			crq->valid = 0;
3819 			wmb();
3820 		} else
3821 			done = 1;
3822 	}
3823 	spin_unlock_irqrestore(scrq->q_lock, flags);
3824 
3825 	list_for_each_entry_safe(evt, temp, &evt_doneq, queue_list) {
3826 		del_timer(&evt->timer);
3827 		list_del(&evt->queue_list);
3828 		ibmvfc_trc_end(evt);
3829 		evt->done(evt);
3830 	}
3831 }
3832 
3833 static irqreturn_t ibmvfc_interrupt_scsi(int irq, void *scrq_instance)
3834 {
3835 	struct ibmvfc_queue *scrq = (struct ibmvfc_queue *)scrq_instance;
3836 
3837 	ibmvfc_toggle_scrq_irq(scrq, 0);
3838 	ibmvfc_drain_sub_crq(scrq);
3839 
3840 	return IRQ_HANDLED;
3841 }
3842 
3843 /**
3844  * ibmvfc_init_tgt - Set the next init job step for the target
3845  * @tgt:		ibmvfc target struct
3846  * @job_step:	job step to perform
3847  *
3848  **/
3849 static void ibmvfc_init_tgt(struct ibmvfc_target *tgt,
3850 			    void (*job_step) (struct ibmvfc_target *))
3851 {
3852 	if (!ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT))
3853 		tgt->job_step = job_step;
3854 	wake_up(&tgt->vhost->work_wait_q);
3855 }
3856 
3857 /**
3858  * ibmvfc_retry_tgt_init - Attempt to retry a step in target initialization
3859  * @tgt:		ibmvfc target struct
3860  * @job_step:	initialization job step
3861  *
3862  * Returns: 1 if step will be retried / 0 if not
3863  *
3864  **/
3865 static int ibmvfc_retry_tgt_init(struct ibmvfc_target *tgt,
3866 				  void (*job_step) (struct ibmvfc_target *))
3867 {
3868 	if (++tgt->init_retries > IBMVFC_MAX_TGT_INIT_RETRIES) {
3869 		ibmvfc_del_tgt(tgt);
3870 		wake_up(&tgt->vhost->work_wait_q);
3871 		return 0;
3872 	} else
3873 		ibmvfc_init_tgt(tgt, job_step);
3874 	return 1;
3875 }
3876 
3877 /* Defined in FC-LS */
3878 static const struct {
3879 	int code;
3880 	int retry;
3881 	int logged_in;
3882 } prli_rsp [] = {
3883 	{ 0, 1, 0 },
3884 	{ 1, 0, 1 },
3885 	{ 2, 1, 0 },
3886 	{ 3, 1, 0 },
3887 	{ 4, 0, 0 },
3888 	{ 5, 0, 0 },
3889 	{ 6, 0, 1 },
3890 	{ 7, 0, 0 },
3891 	{ 8, 1, 0 },
3892 };
3893 
3894 /**
3895  * ibmvfc_get_prli_rsp - Find PRLI response index
3896  * @flags:	PRLI response flags
3897  *
3898  **/
3899 static int ibmvfc_get_prli_rsp(u16 flags)
3900 {
3901 	int i;
3902 	int code = (flags & 0x0f00) >> 8;
3903 
3904 	for (i = 0; i < ARRAY_SIZE(prli_rsp); i++)
3905 		if (prli_rsp[i].code == code)
3906 			return i;
3907 
3908 	return 0;
3909 }
3910 
3911 /**
3912  * ibmvfc_tgt_prli_done - Completion handler for Process Login
3913  * @evt:	ibmvfc event struct
3914  *
3915  **/
3916 static void ibmvfc_tgt_prli_done(struct ibmvfc_event *evt)
3917 {
3918 	struct ibmvfc_target *tgt = evt->tgt;
3919 	struct ibmvfc_host *vhost = evt->vhost;
3920 	struct ibmvfc_process_login *rsp = &evt->xfer_iu->prli;
3921 	struct ibmvfc_prli_svc_parms *parms = &rsp->parms;
3922 	u32 status = be16_to_cpu(rsp->common.status);
3923 	int index, level = IBMVFC_DEFAULT_LOG_LEVEL;
3924 
3925 	vhost->discovery_threads--;
3926 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3927 	switch (status) {
3928 	case IBMVFC_MAD_SUCCESS:
3929 		tgt_dbg(tgt, "Process Login succeeded: %X %02X %04X\n",
3930 			parms->type, parms->flags, parms->service_parms);
3931 
3932 		if (parms->type == IBMVFC_SCSI_FCP_TYPE) {
3933 			index = ibmvfc_get_prli_rsp(be16_to_cpu(parms->flags));
3934 			if (prli_rsp[index].logged_in) {
3935 				if (be16_to_cpu(parms->flags) & IBMVFC_PRLI_EST_IMG_PAIR) {
3936 					tgt->need_login = 0;
3937 					tgt->ids.roles = 0;
3938 					if (be32_to_cpu(parms->service_parms) & IBMVFC_PRLI_TARGET_FUNC)
3939 						tgt->ids.roles |= FC_PORT_ROLE_FCP_TARGET;
3940 					if (be32_to_cpu(parms->service_parms) & IBMVFC_PRLI_INITIATOR_FUNC)
3941 						tgt->ids.roles |= FC_PORT_ROLE_FCP_INITIATOR;
3942 					tgt->add_rport = 1;
3943 				} else
3944 					ibmvfc_del_tgt(tgt);
3945 			} else if (prli_rsp[index].retry)
3946 				ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_prli);
3947 			else
3948 				ibmvfc_del_tgt(tgt);
3949 		} else
3950 			ibmvfc_del_tgt(tgt);
3951 		break;
3952 	case IBMVFC_MAD_DRIVER_FAILED:
3953 		break;
3954 	case IBMVFC_MAD_CRQ_ERROR:
3955 		ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_prli);
3956 		break;
3957 	case IBMVFC_MAD_FAILED:
3958 	default:
3959 		if ((be16_to_cpu(rsp->status) & IBMVFC_VIOS_FAILURE) &&
3960 		     be16_to_cpu(rsp->error) == IBMVFC_PLOGI_REQUIRED)
3961 			level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_plogi);
3962 		else if (tgt->logo_rcvd)
3963 			level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_plogi);
3964 		else if (ibmvfc_retry_cmd(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)))
3965 			level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_prli);
3966 		else
3967 			ibmvfc_del_tgt(tgt);
3968 
3969 		tgt_log(tgt, level, "Process Login failed: %s (%x:%x) rc=0x%02X\n",
3970 			ibmvfc_get_cmd_error(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)),
3971 			be16_to_cpu(rsp->status), be16_to_cpu(rsp->error), status);
3972 		break;
3973 	}
3974 
3975 	kref_put(&tgt->kref, ibmvfc_release_tgt);
3976 	ibmvfc_free_event(evt);
3977 	wake_up(&vhost->work_wait_q);
3978 }
3979 
3980 /**
3981  * ibmvfc_tgt_send_prli - Send a process login
3982  * @tgt:	ibmvfc target struct
3983  *
3984  **/
3985 static void ibmvfc_tgt_send_prli(struct ibmvfc_target *tgt)
3986 {
3987 	struct ibmvfc_process_login *prli;
3988 	struct ibmvfc_host *vhost = tgt->vhost;
3989 	struct ibmvfc_event *evt;
3990 
3991 	if (vhost->discovery_threads >= disc_threads)
3992 		return;
3993 
3994 	kref_get(&tgt->kref);
3995 	evt = ibmvfc_get_event(&vhost->crq);
3996 	vhost->discovery_threads++;
3997 	ibmvfc_init_event(evt, ibmvfc_tgt_prli_done, IBMVFC_MAD_FORMAT);
3998 	evt->tgt = tgt;
3999 	prli = &evt->iu.prli;
4000 	memset(prli, 0, sizeof(*prli));
4001 	if (ibmvfc_check_caps(vhost, IBMVFC_HANDLE_VF_WWPN)) {
4002 		prli->common.version = cpu_to_be32(2);
4003 		prli->target_wwpn = cpu_to_be64(tgt->wwpn);
4004 	} else {
4005 		prli->common.version = cpu_to_be32(1);
4006 	}
4007 	prli->common.opcode = cpu_to_be32(IBMVFC_PROCESS_LOGIN);
4008 	prli->common.length = cpu_to_be16(sizeof(*prli));
4009 	prli->scsi_id = cpu_to_be64(tgt->scsi_id);
4010 
4011 	prli->parms.type = IBMVFC_SCSI_FCP_TYPE;
4012 	prli->parms.flags = cpu_to_be16(IBMVFC_PRLI_EST_IMG_PAIR);
4013 	prli->parms.service_parms = cpu_to_be32(IBMVFC_PRLI_INITIATOR_FUNC);
4014 	prli->parms.service_parms |= cpu_to_be32(IBMVFC_PRLI_READ_FCP_XFER_RDY_DISABLED);
4015 
4016 	if (cls3_error)
4017 		prli->parms.service_parms |= cpu_to_be32(IBMVFC_PRLI_RETRY);
4018 
4019 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
4020 	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
4021 		vhost->discovery_threads--;
4022 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
4023 		kref_put(&tgt->kref, ibmvfc_release_tgt);
4024 	} else
4025 		tgt_dbg(tgt, "Sent process login\n");
4026 }
4027 
4028 /**
4029  * ibmvfc_tgt_plogi_done - Completion handler for Port Login
4030  * @evt:	ibmvfc event struct
4031  *
4032  **/
4033 static void ibmvfc_tgt_plogi_done(struct ibmvfc_event *evt)
4034 {
4035 	struct ibmvfc_target *tgt = evt->tgt;
4036 	struct ibmvfc_host *vhost = evt->vhost;
4037 	struct ibmvfc_port_login *rsp = &evt->xfer_iu->plogi;
4038 	u32 status = be16_to_cpu(rsp->common.status);
4039 	int level = IBMVFC_DEFAULT_LOG_LEVEL;
4040 
4041 	vhost->discovery_threads--;
4042 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
4043 	switch (status) {
4044 	case IBMVFC_MAD_SUCCESS:
4045 		tgt_dbg(tgt, "Port Login succeeded\n");
4046 		if (tgt->ids.port_name &&
4047 		    tgt->ids.port_name != wwn_to_u64(rsp->service_parms.port_name)) {
4048 			vhost->reinit = 1;
4049 			tgt_dbg(tgt, "Port re-init required\n");
4050 			break;
4051 		}
4052 		tgt->ids.node_name = wwn_to_u64(rsp->service_parms.node_name);
4053 		tgt->ids.port_name = wwn_to_u64(rsp->service_parms.port_name);
4054 		tgt->ids.port_id = tgt->scsi_id;
4055 		memcpy(&tgt->service_parms, &rsp->service_parms,
4056 		       sizeof(tgt->service_parms));
4057 		memcpy(&tgt->service_parms_change, &rsp->service_parms_change,
4058 		       sizeof(tgt->service_parms_change));
4059 		ibmvfc_init_tgt(tgt, ibmvfc_tgt_send_prli);
4060 		break;
4061 	case IBMVFC_MAD_DRIVER_FAILED:
4062 		break;
4063 	case IBMVFC_MAD_CRQ_ERROR:
4064 		ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_plogi);
4065 		break;
4066 	case IBMVFC_MAD_FAILED:
4067 	default:
4068 		if (ibmvfc_retry_cmd(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)))
4069 			level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_plogi);
4070 		else
4071 			ibmvfc_del_tgt(tgt);
4072 
4073 		tgt_log(tgt, level, "Port Login failed: %s (%x:%x) %s (%x) %s (%x) rc=0x%02X\n",
4074 			ibmvfc_get_cmd_error(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)),
4075 					     be16_to_cpu(rsp->status), be16_to_cpu(rsp->error),
4076 			ibmvfc_get_fc_type(be16_to_cpu(rsp->fc_type)), be16_to_cpu(rsp->fc_type),
4077 			ibmvfc_get_ls_explain(be16_to_cpu(rsp->fc_explain)), be16_to_cpu(rsp->fc_explain), status);
4078 		break;
4079 	}
4080 
4081 	kref_put(&tgt->kref, ibmvfc_release_tgt);
4082 	ibmvfc_free_event(evt);
4083 	wake_up(&vhost->work_wait_q);
4084 }
4085 
4086 /**
4087  * ibmvfc_tgt_send_plogi - Send PLOGI to the specified target
4088  * @tgt:	ibmvfc target struct
4089  *
4090  **/
4091 static void ibmvfc_tgt_send_plogi(struct ibmvfc_target *tgt)
4092 {
4093 	struct ibmvfc_port_login *plogi;
4094 	struct ibmvfc_host *vhost = tgt->vhost;
4095 	struct ibmvfc_event *evt;
4096 
4097 	if (vhost->discovery_threads >= disc_threads)
4098 		return;
4099 
4100 	kref_get(&tgt->kref);
4101 	tgt->logo_rcvd = 0;
4102 	evt = ibmvfc_get_event(&vhost->crq);
4103 	vhost->discovery_threads++;
4104 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
4105 	ibmvfc_init_event(evt, ibmvfc_tgt_plogi_done, IBMVFC_MAD_FORMAT);
4106 	evt->tgt = tgt;
4107 	plogi = &evt->iu.plogi;
4108 	memset(plogi, 0, sizeof(*plogi));
4109 	if (ibmvfc_check_caps(vhost, IBMVFC_HANDLE_VF_WWPN)) {
4110 		plogi->common.version = cpu_to_be32(2);
4111 		plogi->target_wwpn = cpu_to_be64(tgt->wwpn);
4112 	} else {
4113 		plogi->common.version = cpu_to_be32(1);
4114 	}
4115 	plogi->common.opcode = cpu_to_be32(IBMVFC_PORT_LOGIN);
4116 	plogi->common.length = cpu_to_be16(sizeof(*plogi));
4117 	plogi->scsi_id = cpu_to_be64(tgt->scsi_id);
4118 
4119 	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
4120 		vhost->discovery_threads--;
4121 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
4122 		kref_put(&tgt->kref, ibmvfc_release_tgt);
4123 	} else
4124 		tgt_dbg(tgt, "Sent port login\n");
4125 }
4126 
4127 /**
4128  * ibmvfc_tgt_implicit_logout_done - Completion handler for Implicit Logout MAD
4129  * @evt:	ibmvfc event struct
4130  *
4131  **/
4132 static void ibmvfc_tgt_implicit_logout_done(struct ibmvfc_event *evt)
4133 {
4134 	struct ibmvfc_target *tgt = evt->tgt;
4135 	struct ibmvfc_host *vhost = evt->vhost;
4136 	struct ibmvfc_implicit_logout *rsp = &evt->xfer_iu->implicit_logout;
4137 	u32 status = be16_to_cpu(rsp->common.status);
4138 
4139 	vhost->discovery_threads--;
4140 	ibmvfc_free_event(evt);
4141 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
4142 
4143 	switch (status) {
4144 	case IBMVFC_MAD_SUCCESS:
4145 		tgt_dbg(tgt, "Implicit Logout succeeded\n");
4146 		break;
4147 	case IBMVFC_MAD_DRIVER_FAILED:
4148 		kref_put(&tgt->kref, ibmvfc_release_tgt);
4149 		wake_up(&vhost->work_wait_q);
4150 		return;
4151 	case IBMVFC_MAD_FAILED:
4152 	default:
4153 		tgt_err(tgt, "Implicit Logout failed: rc=0x%02X\n", status);
4154 		break;
4155 	}
4156 
4157 	ibmvfc_init_tgt(tgt, ibmvfc_tgt_send_plogi);
4158 	kref_put(&tgt->kref, ibmvfc_release_tgt);
4159 	wake_up(&vhost->work_wait_q);
4160 }
4161 
4162 /**
4163  * __ibmvfc_tgt_get_implicit_logout_evt - Allocate and init an event for implicit logout
4164  * @tgt:		ibmvfc target struct
4165  *
4166  * Returns:
4167  *	Allocated and initialized ibmvfc_event struct
4168  **/
4169 static struct ibmvfc_event *__ibmvfc_tgt_get_implicit_logout_evt(struct ibmvfc_target *tgt,
4170 								 void (*done) (struct ibmvfc_event *))
4171 {
4172 	struct ibmvfc_implicit_logout *mad;
4173 	struct ibmvfc_host *vhost = tgt->vhost;
4174 	struct ibmvfc_event *evt;
4175 
4176 	kref_get(&tgt->kref);
4177 	evt = ibmvfc_get_event(&vhost->crq);
4178 	ibmvfc_init_event(evt, done, IBMVFC_MAD_FORMAT);
4179 	evt->tgt = tgt;
4180 	mad = &evt->iu.implicit_logout;
4181 	memset(mad, 0, sizeof(*mad));
4182 	mad->common.version = cpu_to_be32(1);
4183 	mad->common.opcode = cpu_to_be32(IBMVFC_IMPLICIT_LOGOUT);
4184 	mad->common.length = cpu_to_be16(sizeof(*mad));
4185 	mad->old_scsi_id = cpu_to_be64(tgt->scsi_id);
4186 	return evt;
4187 }
4188 
4189 /**
4190  * ibmvfc_tgt_implicit_logout - Initiate an Implicit Logout for specified target
4191  * @tgt:		ibmvfc target struct
4192  *
4193  **/
4194 static void ibmvfc_tgt_implicit_logout(struct ibmvfc_target *tgt)
4195 {
4196 	struct ibmvfc_host *vhost = tgt->vhost;
4197 	struct ibmvfc_event *evt;
4198 
4199 	if (vhost->discovery_threads >= disc_threads)
4200 		return;
4201 
4202 	vhost->discovery_threads++;
4203 	evt = __ibmvfc_tgt_get_implicit_logout_evt(tgt,
4204 						   ibmvfc_tgt_implicit_logout_done);
4205 
4206 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
4207 	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
4208 		vhost->discovery_threads--;
4209 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
4210 		kref_put(&tgt->kref, ibmvfc_release_tgt);
4211 	} else
4212 		tgt_dbg(tgt, "Sent Implicit Logout\n");
4213 }
4214 
4215 /**
4216  * ibmvfc_tgt_implicit_logout_and_del_done - Completion handler for Implicit Logout MAD
4217  * @evt:	ibmvfc event struct
4218  *
4219  **/
4220 static void ibmvfc_tgt_implicit_logout_and_del_done(struct ibmvfc_event *evt)
4221 {
4222 	struct ibmvfc_target *tgt = evt->tgt;
4223 	struct ibmvfc_host *vhost = evt->vhost;
4224 	struct ibmvfc_passthru_mad *mad = &evt->xfer_iu->passthru;
4225 	u32 status = be16_to_cpu(mad->common.status);
4226 
4227 	vhost->discovery_threads--;
4228 	ibmvfc_free_event(evt);
4229 
4230 	/*
4231 	 * If our state is IBMVFC_HOST_OFFLINE, we could be unloading the
4232 	 * driver in which case we need to free up all the targets. If we are
4233 	 * not unloading, we will still go through a hard reset to get out of
4234 	 * offline state, so there is no need to track the old targets in that
4235 	 * case.
4236 	 */
4237 	if (status == IBMVFC_MAD_SUCCESS || vhost->state == IBMVFC_HOST_OFFLINE)
4238 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
4239 	else
4240 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_AND_LOGOUT_RPORT);
4241 
4242 	tgt_dbg(tgt, "Implicit Logout %s\n", (status == IBMVFC_MAD_SUCCESS) ? "succeeded" : "failed");
4243 	kref_put(&tgt->kref, ibmvfc_release_tgt);
4244 	wake_up(&vhost->work_wait_q);
4245 }
4246 
4247 /**
4248  * ibmvfc_tgt_implicit_logout_and_del - Initiate an Implicit Logout for specified target
4249  * @tgt:		ibmvfc target struct
4250  *
4251  **/
4252 static void ibmvfc_tgt_implicit_logout_and_del(struct ibmvfc_target *tgt)
4253 {
4254 	struct ibmvfc_host *vhost = tgt->vhost;
4255 	struct ibmvfc_event *evt;
4256 
4257 	if (!vhost->logged_in) {
4258 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
4259 		return;
4260 	}
4261 
4262 	if (vhost->discovery_threads >= disc_threads)
4263 		return;
4264 
4265 	vhost->discovery_threads++;
4266 	evt = __ibmvfc_tgt_get_implicit_logout_evt(tgt,
4267 						   ibmvfc_tgt_implicit_logout_and_del_done);
4268 
4269 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_LOGOUT_RPORT_WAIT);
4270 	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
4271 		vhost->discovery_threads--;
4272 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
4273 		kref_put(&tgt->kref, ibmvfc_release_tgt);
4274 	} else
4275 		tgt_dbg(tgt, "Sent Implicit Logout\n");
4276 }
4277 
4278 /**
4279  * ibmvfc_tgt_move_login_done - Completion handler for Move Login
4280  * @evt:	ibmvfc event struct
4281  *
4282  **/
4283 static void ibmvfc_tgt_move_login_done(struct ibmvfc_event *evt)
4284 {
4285 	struct ibmvfc_target *tgt = evt->tgt;
4286 	struct ibmvfc_host *vhost = evt->vhost;
4287 	struct ibmvfc_move_login *rsp = &evt->xfer_iu->move_login;
4288 	u32 status = be16_to_cpu(rsp->common.status);
4289 	int level = IBMVFC_DEFAULT_LOG_LEVEL;
4290 
4291 	vhost->discovery_threads--;
4292 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
4293 	switch (status) {
4294 	case IBMVFC_MAD_SUCCESS:
4295 		tgt_dbg(tgt, "Move Login succeeded for old scsi_id: %llX\n", tgt->old_scsi_id);
4296 		tgt->ids.node_name = wwn_to_u64(rsp->service_parms.node_name);
4297 		tgt->ids.port_name = wwn_to_u64(rsp->service_parms.port_name);
4298 		tgt->ids.port_id = tgt->scsi_id;
4299 		memcpy(&tgt->service_parms, &rsp->service_parms,
4300 		       sizeof(tgt->service_parms));
4301 		memcpy(&tgt->service_parms_change, &rsp->service_parms_change,
4302 		       sizeof(tgt->service_parms_change));
4303 		ibmvfc_init_tgt(tgt, ibmvfc_tgt_send_prli);
4304 		break;
4305 	case IBMVFC_MAD_DRIVER_FAILED:
4306 		break;
4307 	case IBMVFC_MAD_CRQ_ERROR:
4308 		ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_move_login);
4309 		break;
4310 	case IBMVFC_MAD_FAILED:
4311 	default:
4312 		level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_move_login);
4313 
4314 		tgt_log(tgt, level,
4315 			"Move Login failed: old scsi_id: %llX, flags:%x, vios_flags:%x, rc=0x%02X\n",
4316 			tgt->old_scsi_id, be32_to_cpu(rsp->flags), be16_to_cpu(rsp->vios_flags),
4317 			status);
4318 		break;
4319 	}
4320 
4321 	kref_put(&tgt->kref, ibmvfc_release_tgt);
4322 	ibmvfc_free_event(evt);
4323 	wake_up(&vhost->work_wait_q);
4324 }
4325 
4326 
4327 /**
4328  * ibmvfc_tgt_move_login - Initiate a move login for specified target
4329  * @tgt:		ibmvfc target struct
4330  *
4331  **/
4332 static void ibmvfc_tgt_move_login(struct ibmvfc_target *tgt)
4333 {
4334 	struct ibmvfc_host *vhost = tgt->vhost;
4335 	struct ibmvfc_move_login *move;
4336 	struct ibmvfc_event *evt;
4337 
4338 	if (vhost->discovery_threads >= disc_threads)
4339 		return;
4340 
4341 	kref_get(&tgt->kref);
4342 	evt = ibmvfc_get_event(&vhost->crq);
4343 	vhost->discovery_threads++;
4344 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
4345 	ibmvfc_init_event(evt, ibmvfc_tgt_move_login_done, IBMVFC_MAD_FORMAT);
4346 	evt->tgt = tgt;
4347 	move = &evt->iu.move_login;
4348 	memset(move, 0, sizeof(*move));
4349 	move->common.version = cpu_to_be32(1);
4350 	move->common.opcode = cpu_to_be32(IBMVFC_MOVE_LOGIN);
4351 	move->common.length = cpu_to_be16(sizeof(*move));
4352 
4353 	move->old_scsi_id = cpu_to_be64(tgt->old_scsi_id);
4354 	move->new_scsi_id = cpu_to_be64(tgt->scsi_id);
4355 	move->wwpn = cpu_to_be64(tgt->wwpn);
4356 	move->node_name = cpu_to_be64(tgt->ids.node_name);
4357 
4358 	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
4359 		vhost->discovery_threads--;
4360 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
4361 		kref_put(&tgt->kref, ibmvfc_release_tgt);
4362 	} else
4363 		tgt_dbg(tgt, "Sent Move Login for old scsi_id: %llX\n", tgt->old_scsi_id);
4364 }
4365 
4366 /**
4367  * ibmvfc_adisc_needs_plogi - Does device need PLOGI?
4368  * @mad:	ibmvfc passthru mad struct
4369  * @tgt:	ibmvfc target struct
4370  *
4371  * Returns:
4372  *	1 if PLOGI needed / 0 if PLOGI not needed
4373  **/
4374 static int ibmvfc_adisc_needs_plogi(struct ibmvfc_passthru_mad *mad,
4375 				    struct ibmvfc_target *tgt)
4376 {
4377 	if (wwn_to_u64((u8 *)&mad->fc_iu.response[2]) != tgt->ids.port_name)
4378 		return 1;
4379 	if (wwn_to_u64((u8 *)&mad->fc_iu.response[4]) != tgt->ids.node_name)
4380 		return 1;
4381 	if (be32_to_cpu(mad->fc_iu.response[6]) != tgt->scsi_id)
4382 		return 1;
4383 	return 0;
4384 }
4385 
4386 /**
4387  * ibmvfc_tgt_adisc_done - Completion handler for ADISC
4388  * @evt:	ibmvfc event struct
4389  *
4390  **/
4391 static void ibmvfc_tgt_adisc_done(struct ibmvfc_event *evt)
4392 {
4393 	struct ibmvfc_target *tgt = evt->tgt;
4394 	struct ibmvfc_host *vhost = evt->vhost;
4395 	struct ibmvfc_passthru_mad *mad = &evt->xfer_iu->passthru;
4396 	u32 status = be16_to_cpu(mad->common.status);
4397 	u8 fc_reason, fc_explain;
4398 
4399 	vhost->discovery_threads--;
4400 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
4401 	del_timer(&tgt->timer);
4402 
4403 	switch (status) {
4404 	case IBMVFC_MAD_SUCCESS:
4405 		tgt_dbg(tgt, "ADISC succeeded\n");
4406 		if (ibmvfc_adisc_needs_plogi(mad, tgt))
4407 			ibmvfc_del_tgt(tgt);
4408 		break;
4409 	case IBMVFC_MAD_DRIVER_FAILED:
4410 		break;
4411 	case IBMVFC_MAD_FAILED:
4412 	default:
4413 		ibmvfc_del_tgt(tgt);
4414 		fc_reason = (be32_to_cpu(mad->fc_iu.response[1]) & 0x00ff0000) >> 16;
4415 		fc_explain = (be32_to_cpu(mad->fc_iu.response[1]) & 0x0000ff00) >> 8;
4416 		tgt_info(tgt, "ADISC failed: %s (%x:%x) %s (%x) %s (%x) rc=0x%02X\n",
4417 			 ibmvfc_get_cmd_error(be16_to_cpu(mad->iu.status), be16_to_cpu(mad->iu.error)),
4418 			 be16_to_cpu(mad->iu.status), be16_to_cpu(mad->iu.error),
4419 			 ibmvfc_get_fc_type(fc_reason), fc_reason,
4420 			 ibmvfc_get_ls_explain(fc_explain), fc_explain, status);
4421 		break;
4422 	}
4423 
4424 	kref_put(&tgt->kref, ibmvfc_release_tgt);
4425 	ibmvfc_free_event(evt);
4426 	wake_up(&vhost->work_wait_q);
4427 }
4428 
4429 /**
4430  * ibmvfc_init_passthru - Initialize an event struct for FC passthru
4431  * @evt:		ibmvfc event struct
4432  *
4433  **/
4434 static void ibmvfc_init_passthru(struct ibmvfc_event *evt)
4435 {
4436 	struct ibmvfc_passthru_mad *mad = &evt->iu.passthru;
4437 
4438 	memset(mad, 0, sizeof(*mad));
4439 	mad->common.version = cpu_to_be32(1);
4440 	mad->common.opcode = cpu_to_be32(IBMVFC_PASSTHRU);
4441 	mad->common.length = cpu_to_be16(sizeof(*mad) - sizeof(mad->fc_iu) - sizeof(mad->iu));
4442 	mad->cmd_ioba.va = cpu_to_be64((u64)be64_to_cpu(evt->crq.ioba) +
4443 		offsetof(struct ibmvfc_passthru_mad, iu));
4444 	mad->cmd_ioba.len = cpu_to_be32(sizeof(mad->iu));
4445 	mad->iu.cmd_len = cpu_to_be32(sizeof(mad->fc_iu.payload));
4446 	mad->iu.rsp_len = cpu_to_be32(sizeof(mad->fc_iu.response));
4447 	mad->iu.cmd.va = cpu_to_be64((u64)be64_to_cpu(evt->crq.ioba) +
4448 		offsetof(struct ibmvfc_passthru_mad, fc_iu) +
4449 		offsetof(struct ibmvfc_passthru_fc_iu, payload));
4450 	mad->iu.cmd.len = cpu_to_be32(sizeof(mad->fc_iu.payload));
4451 	mad->iu.rsp.va = cpu_to_be64((u64)be64_to_cpu(evt->crq.ioba) +
4452 		offsetof(struct ibmvfc_passthru_mad, fc_iu) +
4453 		offsetof(struct ibmvfc_passthru_fc_iu, response));
4454 	mad->iu.rsp.len = cpu_to_be32(sizeof(mad->fc_iu.response));
4455 }
4456 
4457 /**
4458  * ibmvfc_tgt_adisc_cancel_done - Completion handler when cancelling an ADISC
4459  * @evt:		ibmvfc event struct
4460  *
4461  * Just cleanup this event struct. Everything else is handled by
4462  * the ADISC completion handler. If the ADISC never actually comes
4463  * back, we still have the timer running on the ADISC event struct
4464  * which will fire and cause the CRQ to get reset.
4465  *
4466  **/
4467 static void ibmvfc_tgt_adisc_cancel_done(struct ibmvfc_event *evt)
4468 {
4469 	struct ibmvfc_host *vhost = evt->vhost;
4470 	struct ibmvfc_target *tgt = evt->tgt;
4471 
4472 	tgt_dbg(tgt, "ADISC cancel complete\n");
4473 	vhost->abort_threads--;
4474 	ibmvfc_free_event(evt);
4475 	kref_put(&tgt->kref, ibmvfc_release_tgt);
4476 	wake_up(&vhost->work_wait_q);
4477 }
4478 
4479 /**
4480  * ibmvfc_adisc_timeout - Handle an ADISC timeout
4481  * @tgt:		ibmvfc target struct
4482  *
4483  * If an ADISC times out, send a cancel. If the cancel times
4484  * out, reset the CRQ. When the ADISC comes back as cancelled,
4485  * log back into the target.
4486  **/
4487 static void ibmvfc_adisc_timeout(struct timer_list *t)
4488 {
4489 	struct ibmvfc_target *tgt = from_timer(tgt, t, timer);
4490 	struct ibmvfc_host *vhost = tgt->vhost;
4491 	struct ibmvfc_event *evt;
4492 	struct ibmvfc_tmf *tmf;
4493 	unsigned long flags;
4494 	int rc;
4495 
4496 	tgt_dbg(tgt, "ADISC timeout\n");
4497 	spin_lock_irqsave(vhost->host->host_lock, flags);
4498 	if (vhost->abort_threads >= disc_threads ||
4499 	    tgt->action != IBMVFC_TGT_ACTION_INIT_WAIT ||
4500 	    vhost->state != IBMVFC_INITIALIZING ||
4501 	    vhost->action != IBMVFC_HOST_ACTION_QUERY_TGTS) {
4502 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
4503 		return;
4504 	}
4505 
4506 	vhost->abort_threads++;
4507 	kref_get(&tgt->kref);
4508 	evt = ibmvfc_get_event(&vhost->crq);
4509 	ibmvfc_init_event(evt, ibmvfc_tgt_adisc_cancel_done, IBMVFC_MAD_FORMAT);
4510 
4511 	evt->tgt = tgt;
4512 	tmf = &evt->iu.tmf;
4513 	memset(tmf, 0, sizeof(*tmf));
4514 	if (ibmvfc_check_caps(vhost, IBMVFC_HANDLE_VF_WWPN)) {
4515 		tmf->common.version = cpu_to_be32(2);
4516 		tmf->target_wwpn = cpu_to_be64(tgt->wwpn);
4517 	} else {
4518 		tmf->common.version = cpu_to_be32(1);
4519 	}
4520 	tmf->common.opcode = cpu_to_be32(IBMVFC_TMF_MAD);
4521 	tmf->common.length = cpu_to_be16(sizeof(*tmf));
4522 	tmf->scsi_id = cpu_to_be64(tgt->scsi_id);
4523 	tmf->cancel_key = cpu_to_be32(tgt->cancel_key);
4524 
4525 	rc = ibmvfc_send_event(evt, vhost, default_timeout);
4526 
4527 	if (rc) {
4528 		tgt_err(tgt, "Failed to send cancel event for ADISC. rc=%d\n", rc);
4529 		vhost->abort_threads--;
4530 		kref_put(&tgt->kref, ibmvfc_release_tgt);
4531 		__ibmvfc_reset_host(vhost);
4532 	} else
4533 		tgt_dbg(tgt, "Attempting to cancel ADISC\n");
4534 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
4535 }
4536 
4537 /**
4538  * ibmvfc_tgt_adisc - Initiate an ADISC for specified target
4539  * @tgt:		ibmvfc target struct
4540  *
4541  * When sending an ADISC we end up with two timers running. The
4542  * first timer is the timer in the ibmvfc target struct. If this
4543  * fires, we send a cancel to the target. The second timer is the
4544  * timer on the ibmvfc event for the ADISC, which is longer. If that
4545  * fires, it means the ADISC timed out and our attempt to cancel it
4546  * also failed, so we need to reset the CRQ.
4547  **/
4548 static void ibmvfc_tgt_adisc(struct ibmvfc_target *tgt)
4549 {
4550 	struct ibmvfc_passthru_mad *mad;
4551 	struct ibmvfc_host *vhost = tgt->vhost;
4552 	struct ibmvfc_event *evt;
4553 
4554 	if (vhost->discovery_threads >= disc_threads)
4555 		return;
4556 
4557 	kref_get(&tgt->kref);
4558 	evt = ibmvfc_get_event(&vhost->crq);
4559 	vhost->discovery_threads++;
4560 	ibmvfc_init_event(evt, ibmvfc_tgt_adisc_done, IBMVFC_MAD_FORMAT);
4561 	evt->tgt = tgt;
4562 
4563 	ibmvfc_init_passthru(evt);
4564 	mad = &evt->iu.passthru;
4565 	mad->iu.flags = cpu_to_be32(IBMVFC_FC_ELS);
4566 	mad->iu.scsi_id = cpu_to_be64(tgt->scsi_id);
4567 	mad->iu.cancel_key = cpu_to_be32(tgt->cancel_key);
4568 
4569 	mad->fc_iu.payload[0] = cpu_to_be32(IBMVFC_ADISC);
4570 	memcpy(&mad->fc_iu.payload[2], &vhost->login_buf->resp.port_name,
4571 	       sizeof(vhost->login_buf->resp.port_name));
4572 	memcpy(&mad->fc_iu.payload[4], &vhost->login_buf->resp.node_name,
4573 	       sizeof(vhost->login_buf->resp.node_name));
4574 	mad->fc_iu.payload[6] = cpu_to_be32(be64_to_cpu(vhost->login_buf->resp.scsi_id) & 0x00ffffff);
4575 
4576 	if (timer_pending(&tgt->timer))
4577 		mod_timer(&tgt->timer, jiffies + (IBMVFC_ADISC_TIMEOUT * HZ));
4578 	else {
4579 		tgt->timer.expires = jiffies + (IBMVFC_ADISC_TIMEOUT * HZ);
4580 		add_timer(&tgt->timer);
4581 	}
4582 
4583 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
4584 	if (ibmvfc_send_event(evt, vhost, IBMVFC_ADISC_PLUS_CANCEL_TIMEOUT)) {
4585 		vhost->discovery_threads--;
4586 		del_timer(&tgt->timer);
4587 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
4588 		kref_put(&tgt->kref, ibmvfc_release_tgt);
4589 	} else
4590 		tgt_dbg(tgt, "Sent ADISC\n");
4591 }
4592 
4593 /**
4594  * ibmvfc_tgt_query_target_done - Completion handler for Query Target MAD
4595  * @evt:	ibmvfc event struct
4596  *
4597  **/
4598 static void ibmvfc_tgt_query_target_done(struct ibmvfc_event *evt)
4599 {
4600 	struct ibmvfc_target *tgt = evt->tgt;
4601 	struct ibmvfc_host *vhost = evt->vhost;
4602 	struct ibmvfc_query_tgt *rsp = &evt->xfer_iu->query_tgt;
4603 	u32 status = be16_to_cpu(rsp->common.status);
4604 	int level = IBMVFC_DEFAULT_LOG_LEVEL;
4605 
4606 	vhost->discovery_threads--;
4607 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
4608 	switch (status) {
4609 	case IBMVFC_MAD_SUCCESS:
4610 		tgt_dbg(tgt, "Query Target succeeded\n");
4611 		if (be64_to_cpu(rsp->scsi_id) != tgt->scsi_id)
4612 			ibmvfc_del_tgt(tgt);
4613 		else
4614 			ibmvfc_init_tgt(tgt, ibmvfc_tgt_adisc);
4615 		break;
4616 	case IBMVFC_MAD_DRIVER_FAILED:
4617 		break;
4618 	case IBMVFC_MAD_CRQ_ERROR:
4619 		ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_query_target);
4620 		break;
4621 	case IBMVFC_MAD_FAILED:
4622 	default:
4623 		if ((be16_to_cpu(rsp->status) & IBMVFC_FABRIC_MAPPED) == IBMVFC_FABRIC_MAPPED &&
4624 		    be16_to_cpu(rsp->error) == IBMVFC_UNABLE_TO_PERFORM_REQ &&
4625 		    be16_to_cpu(rsp->fc_explain) == IBMVFC_PORT_NAME_NOT_REG)
4626 			ibmvfc_del_tgt(tgt);
4627 		else if (ibmvfc_retry_cmd(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)))
4628 			level += ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_query_target);
4629 		else
4630 			ibmvfc_del_tgt(tgt);
4631 
4632 		tgt_log(tgt, level, "Query Target failed: %s (%x:%x) %s (%x) %s (%x) rc=0x%02X\n",
4633 			ibmvfc_get_cmd_error(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)),
4634 			be16_to_cpu(rsp->status), be16_to_cpu(rsp->error),
4635 			ibmvfc_get_fc_type(be16_to_cpu(rsp->fc_type)), be16_to_cpu(rsp->fc_type),
4636 			ibmvfc_get_gs_explain(be16_to_cpu(rsp->fc_explain)), be16_to_cpu(rsp->fc_explain),
4637 			status);
4638 		break;
4639 	}
4640 
4641 	kref_put(&tgt->kref, ibmvfc_release_tgt);
4642 	ibmvfc_free_event(evt);
4643 	wake_up(&vhost->work_wait_q);
4644 }
4645 
4646 /**
4647  * ibmvfc_tgt_query_target - Initiate a Query Target for specified target
4648  * @tgt:	ibmvfc target struct
4649  *
4650  **/
4651 static void ibmvfc_tgt_query_target(struct ibmvfc_target *tgt)
4652 {
4653 	struct ibmvfc_query_tgt *query_tgt;
4654 	struct ibmvfc_host *vhost = tgt->vhost;
4655 	struct ibmvfc_event *evt;
4656 
4657 	if (vhost->discovery_threads >= disc_threads)
4658 		return;
4659 
4660 	kref_get(&tgt->kref);
4661 	evt = ibmvfc_get_event(&vhost->crq);
4662 	vhost->discovery_threads++;
4663 	evt->tgt = tgt;
4664 	ibmvfc_init_event(evt, ibmvfc_tgt_query_target_done, IBMVFC_MAD_FORMAT);
4665 	query_tgt = &evt->iu.query_tgt;
4666 	memset(query_tgt, 0, sizeof(*query_tgt));
4667 	query_tgt->common.version = cpu_to_be32(1);
4668 	query_tgt->common.opcode = cpu_to_be32(IBMVFC_QUERY_TARGET);
4669 	query_tgt->common.length = cpu_to_be16(sizeof(*query_tgt));
4670 	query_tgt->wwpn = cpu_to_be64(tgt->ids.port_name);
4671 
4672 	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
4673 	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
4674 		vhost->discovery_threads--;
4675 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
4676 		kref_put(&tgt->kref, ibmvfc_release_tgt);
4677 	} else
4678 		tgt_dbg(tgt, "Sent Query Target\n");
4679 }
4680 
4681 /**
4682  * ibmvfc_alloc_target - Allocate and initialize an ibmvfc target
4683  * @vhost:		ibmvfc host struct
4684  * @scsi_id:	SCSI ID to allocate target for
4685  *
4686  * Returns:
4687  *	0 on success / other on failure
4688  **/
4689 static int ibmvfc_alloc_target(struct ibmvfc_host *vhost,
4690 			       struct ibmvfc_discover_targets_entry *target)
4691 {
4692 	struct ibmvfc_target *stgt = NULL;
4693 	struct ibmvfc_target *wtgt = NULL;
4694 	struct ibmvfc_target *tgt;
4695 	unsigned long flags;
4696 	u64 scsi_id = be32_to_cpu(target->scsi_id) & IBMVFC_DISC_TGT_SCSI_ID_MASK;
4697 	u64 wwpn = be64_to_cpu(target->wwpn);
4698 
4699 	/* Look to see if we already have a target allocated for this SCSI ID or WWPN */
4700 	spin_lock_irqsave(vhost->host->host_lock, flags);
4701 	list_for_each_entry(tgt, &vhost->targets, queue) {
4702 		if (tgt->wwpn == wwpn) {
4703 			wtgt = tgt;
4704 			break;
4705 		}
4706 	}
4707 
4708 	list_for_each_entry(tgt, &vhost->targets, queue) {
4709 		if (tgt->scsi_id == scsi_id) {
4710 			stgt = tgt;
4711 			break;
4712 		}
4713 	}
4714 
4715 	if (wtgt && !stgt) {
4716 		/*
4717 		 * A WWPN target has moved and we still are tracking the old
4718 		 * SCSI ID.  The only way we should be able to get here is if
4719 		 * we attempted to send an implicit logout for the old SCSI ID
4720 		 * and it failed for some reason, such as there being I/O
4721 		 * pending to the target. In this case, we will have already
4722 		 * deleted the rport from the FC transport so we do a move
4723 		 * login, which works even with I/O pending, as it will cancel
4724 		 * any active commands.
4725 		 */
4726 		if (wtgt->action == IBMVFC_TGT_ACTION_LOGOUT_DELETED_RPORT) {
4727 			/*
4728 			 * Do a move login here. The old target is no longer
4729 			 * known to the transport layer We don't use the
4730 			 * normal ibmvfc_set_tgt_action to set this, as we
4731 			 * don't normally want to allow this state change.
4732 			 */
4733 			wtgt->old_scsi_id = wtgt->scsi_id;
4734 			wtgt->scsi_id = scsi_id;
4735 			wtgt->action = IBMVFC_TGT_ACTION_INIT;
4736 			ibmvfc_init_tgt(wtgt, ibmvfc_tgt_move_login);
4737 			goto unlock_out;
4738 		} else {
4739 			tgt_err(wtgt, "Unexpected target state: %d, %p\n",
4740 				wtgt->action, wtgt->rport);
4741 		}
4742 	} else if (stgt) {
4743 		if (tgt->need_login)
4744 			ibmvfc_init_tgt(tgt, ibmvfc_tgt_implicit_logout);
4745 		goto unlock_out;
4746 	}
4747 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
4748 
4749 	tgt = mempool_alloc(vhost->tgt_pool, GFP_NOIO);
4750 	memset(tgt, 0, sizeof(*tgt));
4751 	tgt->scsi_id = scsi_id;
4752 	tgt->wwpn = wwpn;
4753 	tgt->vhost = vhost;
4754 	tgt->need_login = 1;
4755 	timer_setup(&tgt->timer, ibmvfc_adisc_timeout, 0);
4756 	kref_init(&tgt->kref);
4757 	ibmvfc_init_tgt(tgt, ibmvfc_tgt_implicit_logout);
4758 	spin_lock_irqsave(vhost->host->host_lock, flags);
4759 	tgt->cancel_key = vhost->task_set++;
4760 	list_add_tail(&tgt->queue, &vhost->targets);
4761 
4762 unlock_out:
4763 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
4764 	return 0;
4765 }
4766 
4767 /**
4768  * ibmvfc_alloc_targets - Allocate and initialize ibmvfc targets
4769  * @vhost:		ibmvfc host struct
4770  *
4771  * Returns:
4772  *	0 on success / other on failure
4773  **/
4774 static int ibmvfc_alloc_targets(struct ibmvfc_host *vhost)
4775 {
4776 	int i, rc;
4777 
4778 	for (i = 0, rc = 0; !rc && i < vhost->num_targets; i++)
4779 		rc = ibmvfc_alloc_target(vhost, &vhost->disc_buf[i]);
4780 
4781 	return rc;
4782 }
4783 
4784 /**
4785  * ibmvfc_discover_targets_done - Completion handler for discover targets MAD
4786  * @evt:	ibmvfc event struct
4787  *
4788  **/
4789 static void ibmvfc_discover_targets_done(struct ibmvfc_event *evt)
4790 {
4791 	struct ibmvfc_host *vhost = evt->vhost;
4792 	struct ibmvfc_discover_targets *rsp = &evt->xfer_iu->discover_targets;
4793 	u32 mad_status = be16_to_cpu(rsp->common.status);
4794 	int level = IBMVFC_DEFAULT_LOG_LEVEL;
4795 
4796 	switch (mad_status) {
4797 	case IBMVFC_MAD_SUCCESS:
4798 		ibmvfc_dbg(vhost, "Discover Targets succeeded\n");
4799 		vhost->num_targets = be32_to_cpu(rsp->num_written);
4800 		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_ALLOC_TGTS);
4801 		break;
4802 	case IBMVFC_MAD_FAILED:
4803 		level += ibmvfc_retry_host_init(vhost);
4804 		ibmvfc_log(vhost, level, "Discover Targets failed: %s (%x:%x)\n",
4805 			   ibmvfc_get_cmd_error(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)),
4806 			   be16_to_cpu(rsp->status), be16_to_cpu(rsp->error));
4807 		break;
4808 	case IBMVFC_MAD_DRIVER_FAILED:
4809 		break;
4810 	default:
4811 		dev_err(vhost->dev, "Invalid Discover Targets response: 0x%x\n", mad_status);
4812 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4813 		break;
4814 	}
4815 
4816 	ibmvfc_free_event(evt);
4817 	wake_up(&vhost->work_wait_q);
4818 }
4819 
4820 /**
4821  * ibmvfc_discover_targets - Send Discover Targets MAD
4822  * @vhost:	ibmvfc host struct
4823  *
4824  **/
4825 static void ibmvfc_discover_targets(struct ibmvfc_host *vhost)
4826 {
4827 	struct ibmvfc_discover_targets *mad;
4828 	struct ibmvfc_event *evt = ibmvfc_get_event(&vhost->crq);
4829 
4830 	ibmvfc_init_event(evt, ibmvfc_discover_targets_done, IBMVFC_MAD_FORMAT);
4831 	mad = &evt->iu.discover_targets;
4832 	memset(mad, 0, sizeof(*mad));
4833 	mad->common.version = cpu_to_be32(1);
4834 	mad->common.opcode = cpu_to_be32(IBMVFC_DISC_TARGETS);
4835 	mad->common.length = cpu_to_be16(sizeof(*mad));
4836 	mad->bufflen = cpu_to_be32(vhost->disc_buf_sz);
4837 	mad->buffer.va = cpu_to_be64(vhost->disc_buf_dma);
4838 	mad->buffer.len = cpu_to_be32(vhost->disc_buf_sz);
4839 	mad->flags = cpu_to_be32(IBMVFC_DISC_TGT_PORT_ID_WWPN_LIST);
4840 	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT_WAIT);
4841 
4842 	if (!ibmvfc_send_event(evt, vhost, default_timeout))
4843 		ibmvfc_dbg(vhost, "Sent discover targets\n");
4844 	else
4845 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4846 }
4847 
4848 static void ibmvfc_channel_setup_done(struct ibmvfc_event *evt)
4849 {
4850 	struct ibmvfc_host *vhost = evt->vhost;
4851 	struct ibmvfc_channel_setup *setup = vhost->channel_setup_buf;
4852 	struct ibmvfc_scsi_channels *scrqs = &vhost->scsi_scrqs;
4853 	u32 mad_status = be16_to_cpu(evt->xfer_iu->channel_setup.common.status);
4854 	int level = IBMVFC_DEFAULT_LOG_LEVEL;
4855 	int flags, active_queues, i;
4856 
4857 	ibmvfc_free_event(evt);
4858 
4859 	switch (mad_status) {
4860 	case IBMVFC_MAD_SUCCESS:
4861 		ibmvfc_dbg(vhost, "Channel Setup succeeded\n");
4862 		flags = be32_to_cpu(setup->flags);
4863 		vhost->do_enquiry = 0;
4864 		active_queues = be32_to_cpu(setup->num_scsi_subq_channels);
4865 		scrqs->active_queues = active_queues;
4866 
4867 		if (flags & IBMVFC_CHANNELS_CANCELED) {
4868 			ibmvfc_dbg(vhost, "Channels Canceled\n");
4869 			vhost->using_channels = 0;
4870 		} else {
4871 			if (active_queues)
4872 				vhost->using_channels = 1;
4873 			for (i = 0; i < active_queues; i++)
4874 				scrqs->scrqs[i].vios_cookie =
4875 					be64_to_cpu(setup->channel_handles[i]);
4876 
4877 			ibmvfc_dbg(vhost, "Using %u channels\n",
4878 				   vhost->scsi_scrqs.active_queues);
4879 		}
4880 		break;
4881 	case IBMVFC_MAD_FAILED:
4882 		level += ibmvfc_retry_host_init(vhost);
4883 		ibmvfc_log(vhost, level, "Channel Setup failed\n");
4884 		fallthrough;
4885 	case IBMVFC_MAD_DRIVER_FAILED:
4886 		return;
4887 	default:
4888 		dev_err(vhost->dev, "Invalid Channel Setup response: 0x%x\n",
4889 			mad_status);
4890 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4891 		return;
4892 	}
4893 
4894 	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY);
4895 	wake_up(&vhost->work_wait_q);
4896 }
4897 
4898 static void ibmvfc_channel_setup(struct ibmvfc_host *vhost)
4899 {
4900 	struct ibmvfc_channel_setup_mad *mad;
4901 	struct ibmvfc_channel_setup *setup_buf = vhost->channel_setup_buf;
4902 	struct ibmvfc_event *evt = ibmvfc_get_event(&vhost->crq);
4903 	struct ibmvfc_scsi_channels *scrqs = &vhost->scsi_scrqs;
4904 	unsigned int num_channels =
4905 		min(vhost->client_scsi_channels, vhost->max_vios_scsi_channels);
4906 	int i;
4907 
4908 	memset(setup_buf, 0, sizeof(*setup_buf));
4909 	if (num_channels == 0)
4910 		setup_buf->flags = cpu_to_be32(IBMVFC_CANCEL_CHANNELS);
4911 	else {
4912 		setup_buf->num_scsi_subq_channels = cpu_to_be32(num_channels);
4913 		for (i = 0; i < num_channels; i++)
4914 			setup_buf->channel_handles[i] = cpu_to_be64(scrqs->scrqs[i].cookie);
4915 	}
4916 
4917 	ibmvfc_init_event(evt, ibmvfc_channel_setup_done, IBMVFC_MAD_FORMAT);
4918 	mad = &evt->iu.channel_setup;
4919 	memset(mad, 0, sizeof(*mad));
4920 	mad->common.version = cpu_to_be32(1);
4921 	mad->common.opcode = cpu_to_be32(IBMVFC_CHANNEL_SETUP);
4922 	mad->common.length = cpu_to_be16(sizeof(*mad));
4923 	mad->buffer.va = cpu_to_be64(vhost->channel_setup_dma);
4924 	mad->buffer.len = cpu_to_be32(sizeof(*vhost->channel_setup_buf));
4925 
4926 	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT_WAIT);
4927 
4928 	if (!ibmvfc_send_event(evt, vhost, default_timeout))
4929 		ibmvfc_dbg(vhost, "Sent channel setup\n");
4930 	else
4931 		ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
4932 }
4933 
4934 static void ibmvfc_channel_enquiry_done(struct ibmvfc_event *evt)
4935 {
4936 	struct ibmvfc_host *vhost = evt->vhost;
4937 	struct ibmvfc_channel_enquiry *rsp = &evt->xfer_iu->channel_enquiry;
4938 	u32 mad_status = be16_to_cpu(rsp->common.status);
4939 	int level = IBMVFC_DEFAULT_LOG_LEVEL;
4940 
4941 	switch (mad_status) {
4942 	case IBMVFC_MAD_SUCCESS:
4943 		ibmvfc_dbg(vhost, "Channel Enquiry succeeded\n");
4944 		vhost->max_vios_scsi_channels = be32_to_cpu(rsp->num_scsi_subq_channels);
4945 		ibmvfc_free_event(evt);
4946 		break;
4947 	case IBMVFC_MAD_FAILED:
4948 		level += ibmvfc_retry_host_init(vhost);
4949 		ibmvfc_log(vhost, level, "Channel Enquiry failed\n");
4950 		fallthrough;
4951 	case IBMVFC_MAD_DRIVER_FAILED:
4952 		ibmvfc_free_event(evt);
4953 		return;
4954 	default:
4955 		dev_err(vhost->dev, "Invalid Channel Enquiry response: 0x%x\n",
4956 			mad_status);
4957 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4958 		ibmvfc_free_event(evt);
4959 		return;
4960 	}
4961 
4962 	ibmvfc_channel_setup(vhost);
4963 }
4964 
4965 static void ibmvfc_channel_enquiry(struct ibmvfc_host *vhost)
4966 {
4967 	struct ibmvfc_channel_enquiry *mad;
4968 	struct ibmvfc_event *evt = ibmvfc_get_event(&vhost->crq);
4969 
4970 	ibmvfc_init_event(evt, ibmvfc_channel_enquiry_done, IBMVFC_MAD_FORMAT);
4971 	mad = &evt->iu.channel_enquiry;
4972 	memset(mad, 0, sizeof(*mad));
4973 	mad->common.version = cpu_to_be32(1);
4974 	mad->common.opcode = cpu_to_be32(IBMVFC_CHANNEL_ENQUIRY);
4975 	mad->common.length = cpu_to_be16(sizeof(*mad));
4976 
4977 	if (mig_channels_only)
4978 		mad->flags |= cpu_to_be32(IBMVFC_NO_CHANNELS_TO_CRQ_SUPPORT);
4979 	if (mig_no_less_channels)
4980 		mad->flags |= cpu_to_be32(IBMVFC_NO_N_TO_M_CHANNELS_SUPPORT);
4981 
4982 	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT_WAIT);
4983 
4984 	if (!ibmvfc_send_event(evt, vhost, default_timeout))
4985 		ibmvfc_dbg(vhost, "Send channel enquiry\n");
4986 	else
4987 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
4988 }
4989 
4990 /**
4991  * ibmvfc_npiv_login_done - Completion handler for NPIV Login
4992  * @evt:	ibmvfc event struct
4993  *
4994  **/
4995 static void ibmvfc_npiv_login_done(struct ibmvfc_event *evt)
4996 {
4997 	struct ibmvfc_host *vhost = evt->vhost;
4998 	u32 mad_status = be16_to_cpu(evt->xfer_iu->npiv_login.common.status);
4999 	struct ibmvfc_npiv_login_resp *rsp = &vhost->login_buf->resp;
5000 	unsigned int npiv_max_sectors;
5001 	int level = IBMVFC_DEFAULT_LOG_LEVEL;
5002 
5003 	switch (mad_status) {
5004 	case IBMVFC_MAD_SUCCESS:
5005 		ibmvfc_free_event(evt);
5006 		break;
5007 	case IBMVFC_MAD_FAILED:
5008 		if (ibmvfc_retry_cmd(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)))
5009 			level += ibmvfc_retry_host_init(vhost);
5010 		else
5011 			ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
5012 		ibmvfc_log(vhost, level, "NPIV Login failed: %s (%x:%x)\n",
5013 			   ibmvfc_get_cmd_error(be16_to_cpu(rsp->status), be16_to_cpu(rsp->error)),
5014 						be16_to_cpu(rsp->status), be16_to_cpu(rsp->error));
5015 		ibmvfc_free_event(evt);
5016 		return;
5017 	case IBMVFC_MAD_CRQ_ERROR:
5018 		ibmvfc_retry_host_init(vhost);
5019 		fallthrough;
5020 	case IBMVFC_MAD_DRIVER_FAILED:
5021 		ibmvfc_free_event(evt);
5022 		return;
5023 	default:
5024 		dev_err(vhost->dev, "Invalid NPIV Login response: 0x%x\n", mad_status);
5025 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
5026 		ibmvfc_free_event(evt);
5027 		return;
5028 	}
5029 
5030 	vhost->client_migrated = 0;
5031 
5032 	if (!(be32_to_cpu(rsp->flags) & IBMVFC_NATIVE_FC)) {
5033 		dev_err(vhost->dev, "Virtual adapter does not support FC. %x\n",
5034 			rsp->flags);
5035 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
5036 		wake_up(&vhost->work_wait_q);
5037 		return;
5038 	}
5039 
5040 	if (be32_to_cpu(rsp->max_cmds) <= IBMVFC_NUM_INTERNAL_REQ) {
5041 		dev_err(vhost->dev, "Virtual adapter supported queue depth too small: %d\n",
5042 			rsp->max_cmds);
5043 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
5044 		wake_up(&vhost->work_wait_q);
5045 		return;
5046 	}
5047 
5048 	vhost->logged_in = 1;
5049 	npiv_max_sectors = min((uint)(be64_to_cpu(rsp->max_dma_len) >> 9), IBMVFC_MAX_SECTORS);
5050 	dev_info(vhost->dev, "Host partition: %s, device: %s %s %s max sectors %u\n",
5051 		 rsp->partition_name, rsp->device_name, rsp->port_loc_code,
5052 		 rsp->drc_name, npiv_max_sectors);
5053 
5054 	fc_host_fabric_name(vhost->host) = be64_to_cpu(rsp->node_name);
5055 	fc_host_node_name(vhost->host) = be64_to_cpu(rsp->node_name);
5056 	fc_host_port_name(vhost->host) = be64_to_cpu(rsp->port_name);
5057 	fc_host_port_id(vhost->host) = be64_to_cpu(rsp->scsi_id);
5058 	fc_host_port_type(vhost->host) = FC_PORTTYPE_NPIV;
5059 	fc_host_supported_classes(vhost->host) = 0;
5060 	if (be32_to_cpu(rsp->service_parms.class1_parms[0]) & 0x80000000)
5061 		fc_host_supported_classes(vhost->host) |= FC_COS_CLASS1;
5062 	if (be32_to_cpu(rsp->service_parms.class2_parms[0]) & 0x80000000)
5063 		fc_host_supported_classes(vhost->host) |= FC_COS_CLASS2;
5064 	if (be32_to_cpu(rsp->service_parms.class3_parms[0]) & 0x80000000)
5065 		fc_host_supported_classes(vhost->host) |= FC_COS_CLASS3;
5066 	fc_host_maxframe_size(vhost->host) =
5067 		be16_to_cpu(rsp->service_parms.common.bb_rcv_sz) & 0x0fff;
5068 
5069 	vhost->host->can_queue = be32_to_cpu(rsp->max_cmds) - IBMVFC_NUM_INTERNAL_REQ;
5070 	vhost->host->max_sectors = npiv_max_sectors;
5071 
5072 	if (ibmvfc_check_caps(vhost, IBMVFC_CAN_SUPPORT_CHANNELS) && vhost->do_enquiry) {
5073 		ibmvfc_channel_enquiry(vhost);
5074 	} else {
5075 		vhost->do_enquiry = 0;
5076 		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY);
5077 		wake_up(&vhost->work_wait_q);
5078 	}
5079 }
5080 
5081 /**
5082  * ibmvfc_npiv_login - Sends NPIV login
5083  * @vhost:	ibmvfc host struct
5084  *
5085  **/
5086 static void ibmvfc_npiv_login(struct ibmvfc_host *vhost)
5087 {
5088 	struct ibmvfc_npiv_login_mad *mad;
5089 	struct ibmvfc_event *evt = ibmvfc_get_event(&vhost->crq);
5090 
5091 	ibmvfc_gather_partition_info(vhost);
5092 	ibmvfc_set_login_info(vhost);
5093 	ibmvfc_init_event(evt, ibmvfc_npiv_login_done, IBMVFC_MAD_FORMAT);
5094 
5095 	memcpy(vhost->login_buf, &vhost->login_info, sizeof(vhost->login_info));
5096 	mad = &evt->iu.npiv_login;
5097 	memset(mad, 0, sizeof(struct ibmvfc_npiv_login_mad));
5098 	mad->common.version = cpu_to_be32(1);
5099 	mad->common.opcode = cpu_to_be32(IBMVFC_NPIV_LOGIN);
5100 	mad->common.length = cpu_to_be16(sizeof(struct ibmvfc_npiv_login_mad));
5101 	mad->buffer.va = cpu_to_be64(vhost->login_buf_dma);
5102 	mad->buffer.len = cpu_to_be32(sizeof(*vhost->login_buf));
5103 
5104 	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT_WAIT);
5105 
5106 	if (!ibmvfc_send_event(evt, vhost, default_timeout))
5107 		ibmvfc_dbg(vhost, "Sent NPIV login\n");
5108 	else
5109 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
5110 }
5111 
5112 /**
5113  * ibmvfc_npiv_logout_done - Completion handler for NPIV Logout
5114  * @vhost:		ibmvfc host struct
5115  *
5116  **/
5117 static void ibmvfc_npiv_logout_done(struct ibmvfc_event *evt)
5118 {
5119 	struct ibmvfc_host *vhost = evt->vhost;
5120 	u32 mad_status = be16_to_cpu(evt->xfer_iu->npiv_logout.common.status);
5121 
5122 	ibmvfc_free_event(evt);
5123 
5124 	switch (mad_status) {
5125 	case IBMVFC_MAD_SUCCESS:
5126 		if (list_empty(&vhost->crq.sent) &&
5127 		    vhost->action == IBMVFC_HOST_ACTION_LOGO_WAIT) {
5128 			ibmvfc_init_host(vhost);
5129 			return;
5130 		}
5131 		break;
5132 	case IBMVFC_MAD_FAILED:
5133 	case IBMVFC_MAD_NOT_SUPPORTED:
5134 	case IBMVFC_MAD_CRQ_ERROR:
5135 	case IBMVFC_MAD_DRIVER_FAILED:
5136 	default:
5137 		ibmvfc_dbg(vhost, "NPIV Logout failed. 0x%X\n", mad_status);
5138 		break;
5139 	}
5140 
5141 	ibmvfc_hard_reset_host(vhost);
5142 }
5143 
5144 /**
5145  * ibmvfc_npiv_logout - Issue an NPIV Logout
5146  * @vhost:		ibmvfc host struct
5147  *
5148  **/
5149 static void ibmvfc_npiv_logout(struct ibmvfc_host *vhost)
5150 {
5151 	struct ibmvfc_npiv_logout_mad *mad;
5152 	struct ibmvfc_event *evt;
5153 
5154 	evt = ibmvfc_get_event(&vhost->crq);
5155 	ibmvfc_init_event(evt, ibmvfc_npiv_logout_done, IBMVFC_MAD_FORMAT);
5156 
5157 	mad = &evt->iu.npiv_logout;
5158 	memset(mad, 0, sizeof(*mad));
5159 	mad->common.version = cpu_to_be32(1);
5160 	mad->common.opcode = cpu_to_be32(IBMVFC_NPIV_LOGOUT);
5161 	mad->common.length = cpu_to_be16(sizeof(struct ibmvfc_npiv_logout_mad));
5162 
5163 	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_LOGO_WAIT);
5164 
5165 	if (!ibmvfc_send_event(evt, vhost, default_timeout))
5166 		ibmvfc_dbg(vhost, "Sent NPIV logout\n");
5167 	else
5168 		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
5169 }
5170 
5171 /**
5172  * ibmvfc_dev_init_to_do - Is there target initialization work to do?
5173  * @vhost:		ibmvfc host struct
5174  *
5175  * Returns:
5176  *	1 if work to do / 0 if not
5177  **/
5178 static int ibmvfc_dev_init_to_do(struct ibmvfc_host *vhost)
5179 {
5180 	struct ibmvfc_target *tgt;
5181 
5182 	list_for_each_entry(tgt, &vhost->targets, queue) {
5183 		if (tgt->action == IBMVFC_TGT_ACTION_INIT ||
5184 		    tgt->action == IBMVFC_TGT_ACTION_INIT_WAIT)
5185 			return 1;
5186 	}
5187 
5188 	return 0;
5189 }
5190 
5191 /**
5192  * ibmvfc_dev_logo_to_do - Is there target logout work to do?
5193  * @vhost:		ibmvfc host struct
5194  *
5195  * Returns:
5196  *	1 if work to do / 0 if not
5197  **/
5198 static int ibmvfc_dev_logo_to_do(struct ibmvfc_host *vhost)
5199 {
5200 	struct ibmvfc_target *tgt;
5201 
5202 	list_for_each_entry(tgt, &vhost->targets, queue) {
5203 		if (tgt->action == IBMVFC_TGT_ACTION_LOGOUT_RPORT ||
5204 		    tgt->action == IBMVFC_TGT_ACTION_LOGOUT_RPORT_WAIT)
5205 			return 1;
5206 	}
5207 	return 0;
5208 }
5209 
5210 /**
5211  * __ibmvfc_work_to_do - Is there task level work to do? (no locking)
5212  * @vhost:		ibmvfc host struct
5213  *
5214  * Returns:
5215  *	1 if work to do / 0 if not
5216  **/
5217 static int __ibmvfc_work_to_do(struct ibmvfc_host *vhost)
5218 {
5219 	struct ibmvfc_target *tgt;
5220 
5221 	if (kthread_should_stop())
5222 		return 1;
5223 	switch (vhost->action) {
5224 	case IBMVFC_HOST_ACTION_NONE:
5225 	case IBMVFC_HOST_ACTION_INIT_WAIT:
5226 	case IBMVFC_HOST_ACTION_LOGO_WAIT:
5227 		return 0;
5228 	case IBMVFC_HOST_ACTION_TGT_INIT:
5229 	case IBMVFC_HOST_ACTION_QUERY_TGTS:
5230 		if (vhost->discovery_threads == disc_threads)
5231 			return 0;
5232 		list_for_each_entry(tgt, &vhost->targets, queue)
5233 			if (tgt->action == IBMVFC_TGT_ACTION_INIT)
5234 				return 1;
5235 		list_for_each_entry(tgt, &vhost->targets, queue)
5236 			if (tgt->action == IBMVFC_TGT_ACTION_INIT_WAIT)
5237 				return 0;
5238 		return 1;
5239 	case IBMVFC_HOST_ACTION_TGT_DEL:
5240 	case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
5241 		if (vhost->discovery_threads == disc_threads)
5242 			return 0;
5243 		list_for_each_entry(tgt, &vhost->targets, queue)
5244 			if (tgt->action == IBMVFC_TGT_ACTION_LOGOUT_RPORT)
5245 				return 1;
5246 		list_for_each_entry(tgt, &vhost->targets, queue)
5247 			if (tgt->action == IBMVFC_TGT_ACTION_LOGOUT_RPORT_WAIT)
5248 				return 0;
5249 		return 1;
5250 	case IBMVFC_HOST_ACTION_LOGO:
5251 	case IBMVFC_HOST_ACTION_INIT:
5252 	case IBMVFC_HOST_ACTION_ALLOC_TGTS:
5253 	case IBMVFC_HOST_ACTION_QUERY:
5254 	case IBMVFC_HOST_ACTION_RESET:
5255 	case IBMVFC_HOST_ACTION_REENABLE:
5256 	default:
5257 		break;
5258 	}
5259 
5260 	return 1;
5261 }
5262 
5263 /**
5264  * ibmvfc_work_to_do - Is there task level work to do?
5265  * @vhost:		ibmvfc host struct
5266  *
5267  * Returns:
5268  *	1 if work to do / 0 if not
5269  **/
5270 static int ibmvfc_work_to_do(struct ibmvfc_host *vhost)
5271 {
5272 	unsigned long flags;
5273 	int rc;
5274 
5275 	spin_lock_irqsave(vhost->host->host_lock, flags);
5276 	rc = __ibmvfc_work_to_do(vhost);
5277 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
5278 	return rc;
5279 }
5280 
5281 /**
5282  * ibmvfc_log_ae - Log async events if necessary
5283  * @vhost:		ibmvfc host struct
5284  * @events:		events to log
5285  *
5286  **/
5287 static void ibmvfc_log_ae(struct ibmvfc_host *vhost, int events)
5288 {
5289 	if (events & IBMVFC_AE_RSCN)
5290 		fc_host_post_event(vhost->host, fc_get_event_number(), FCH_EVT_RSCN, 0);
5291 	if ((events & IBMVFC_AE_LINKDOWN) &&
5292 	    vhost->state >= IBMVFC_HALTED)
5293 		fc_host_post_event(vhost->host, fc_get_event_number(), FCH_EVT_LINKDOWN, 0);
5294 	if ((events & IBMVFC_AE_LINKUP) &&
5295 	    vhost->state == IBMVFC_INITIALIZING)
5296 		fc_host_post_event(vhost->host, fc_get_event_number(), FCH_EVT_LINKUP, 0);
5297 }
5298 
5299 /**
5300  * ibmvfc_tgt_add_rport - Tell the FC transport about a new remote port
5301  * @tgt:		ibmvfc target struct
5302  *
5303  **/
5304 static void ibmvfc_tgt_add_rport(struct ibmvfc_target *tgt)
5305 {
5306 	struct ibmvfc_host *vhost = tgt->vhost;
5307 	struct fc_rport *rport;
5308 	unsigned long flags;
5309 
5310 	tgt_dbg(tgt, "Adding rport\n");
5311 	rport = fc_remote_port_add(vhost->host, 0, &tgt->ids);
5312 	spin_lock_irqsave(vhost->host->host_lock, flags);
5313 
5314 	if (rport && tgt->action == IBMVFC_TGT_ACTION_DEL_RPORT) {
5315 		tgt_dbg(tgt, "Deleting rport\n");
5316 		list_del(&tgt->queue);
5317 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DELETED_RPORT);
5318 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
5319 		fc_remote_port_delete(rport);
5320 		del_timer_sync(&tgt->timer);
5321 		kref_put(&tgt->kref, ibmvfc_release_tgt);
5322 		return;
5323 	} else if (rport && tgt->action == IBMVFC_TGT_ACTION_DEL_AND_LOGOUT_RPORT) {
5324 		tgt_dbg(tgt, "Deleting rport with outstanding I/O\n");
5325 		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_LOGOUT_DELETED_RPORT);
5326 		tgt->rport = NULL;
5327 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
5328 		fc_remote_port_delete(rport);
5329 		return;
5330 	} else if (rport && tgt->action == IBMVFC_TGT_ACTION_DELETED_RPORT) {
5331 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
5332 		return;
5333 	}
5334 
5335 	if (rport) {
5336 		tgt_dbg(tgt, "rport add succeeded\n");
5337 		tgt->rport = rport;
5338 		rport->maxframe_size = be16_to_cpu(tgt->service_parms.common.bb_rcv_sz) & 0x0fff;
5339 		rport->supported_classes = 0;
5340 		tgt->target_id = rport->scsi_target_id;
5341 		if (be32_to_cpu(tgt->service_parms.class1_parms[0]) & 0x80000000)
5342 			rport->supported_classes |= FC_COS_CLASS1;
5343 		if (be32_to_cpu(tgt->service_parms.class2_parms[0]) & 0x80000000)
5344 			rport->supported_classes |= FC_COS_CLASS2;
5345 		if (be32_to_cpu(tgt->service_parms.class3_parms[0]) & 0x80000000)
5346 			rport->supported_classes |= FC_COS_CLASS3;
5347 		if (rport->rqst_q)
5348 			blk_queue_max_segments(rport->rqst_q, 1);
5349 	} else
5350 		tgt_dbg(tgt, "rport add failed\n");
5351 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
5352 }
5353 
5354 /**
5355  * ibmvfc_do_work - Do task level work
5356  * @vhost:		ibmvfc host struct
5357  *
5358  **/
5359 static void ibmvfc_do_work(struct ibmvfc_host *vhost)
5360 {
5361 	struct ibmvfc_target *tgt;
5362 	unsigned long flags;
5363 	struct fc_rport *rport;
5364 	LIST_HEAD(purge);
5365 	int rc;
5366 
5367 	ibmvfc_log_ae(vhost, vhost->events_to_log);
5368 	spin_lock_irqsave(vhost->host->host_lock, flags);
5369 	vhost->events_to_log = 0;
5370 	switch (vhost->action) {
5371 	case IBMVFC_HOST_ACTION_NONE:
5372 	case IBMVFC_HOST_ACTION_LOGO_WAIT:
5373 	case IBMVFC_HOST_ACTION_INIT_WAIT:
5374 		break;
5375 	case IBMVFC_HOST_ACTION_RESET:
5376 		vhost->action = IBMVFC_HOST_ACTION_TGT_DEL;
5377 		list_splice_init(&vhost->purge, &purge);
5378 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
5379 		ibmvfc_complete_purge(&purge);
5380 		rc = ibmvfc_reset_crq(vhost);
5381 		spin_lock_irqsave(vhost->host->host_lock, flags);
5382 		if (rc == H_CLOSED)
5383 			vio_enable_interrupts(to_vio_dev(vhost->dev));
5384 		if (rc || (rc = ibmvfc_send_crq_init(vhost)) ||
5385 		    (rc = vio_enable_interrupts(to_vio_dev(vhost->dev)))) {
5386 			ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
5387 			dev_err(vhost->dev, "Error after reset (rc=%d)\n", rc);
5388 		}
5389 		break;
5390 	case IBMVFC_HOST_ACTION_REENABLE:
5391 		vhost->action = IBMVFC_HOST_ACTION_TGT_DEL;
5392 		list_splice_init(&vhost->purge, &purge);
5393 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
5394 		ibmvfc_complete_purge(&purge);
5395 		rc = ibmvfc_reenable_crq_queue(vhost);
5396 		spin_lock_irqsave(vhost->host->host_lock, flags);
5397 		if (rc || (rc = ibmvfc_send_crq_init(vhost))) {
5398 			ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
5399 			dev_err(vhost->dev, "Error after enable (rc=%d)\n", rc);
5400 		}
5401 		break;
5402 	case IBMVFC_HOST_ACTION_LOGO:
5403 		vhost->job_step(vhost);
5404 		break;
5405 	case IBMVFC_HOST_ACTION_INIT:
5406 		BUG_ON(vhost->state != IBMVFC_INITIALIZING);
5407 		if (vhost->delay_init) {
5408 			vhost->delay_init = 0;
5409 			spin_unlock_irqrestore(vhost->host->host_lock, flags);
5410 			ssleep(15);
5411 			return;
5412 		} else
5413 			vhost->job_step(vhost);
5414 		break;
5415 	case IBMVFC_HOST_ACTION_QUERY:
5416 		list_for_each_entry(tgt, &vhost->targets, queue)
5417 			ibmvfc_init_tgt(tgt, ibmvfc_tgt_query_target);
5418 		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY_TGTS);
5419 		break;
5420 	case IBMVFC_HOST_ACTION_QUERY_TGTS:
5421 		list_for_each_entry(tgt, &vhost->targets, queue) {
5422 			if (tgt->action == IBMVFC_TGT_ACTION_INIT) {
5423 				tgt->job_step(tgt);
5424 				break;
5425 			}
5426 		}
5427 
5428 		if (!ibmvfc_dev_init_to_do(vhost))
5429 			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_DEL);
5430 		break;
5431 	case IBMVFC_HOST_ACTION_TGT_DEL:
5432 	case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
5433 		list_for_each_entry(tgt, &vhost->targets, queue) {
5434 			if (tgt->action == IBMVFC_TGT_ACTION_LOGOUT_RPORT) {
5435 				tgt->job_step(tgt);
5436 				break;
5437 			}
5438 		}
5439 
5440 		if (ibmvfc_dev_logo_to_do(vhost)) {
5441 			spin_unlock_irqrestore(vhost->host->host_lock, flags);
5442 			return;
5443 		}
5444 
5445 		list_for_each_entry(tgt, &vhost->targets, queue) {
5446 			if (tgt->action == IBMVFC_TGT_ACTION_DEL_RPORT) {
5447 				tgt_dbg(tgt, "Deleting rport\n");
5448 				rport = tgt->rport;
5449 				tgt->rport = NULL;
5450 				list_del(&tgt->queue);
5451 				ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DELETED_RPORT);
5452 				spin_unlock_irqrestore(vhost->host->host_lock, flags);
5453 				if (rport)
5454 					fc_remote_port_delete(rport);
5455 				del_timer_sync(&tgt->timer);
5456 				kref_put(&tgt->kref, ibmvfc_release_tgt);
5457 				return;
5458 			} else if (tgt->action == IBMVFC_TGT_ACTION_DEL_AND_LOGOUT_RPORT) {
5459 				tgt_dbg(tgt, "Deleting rport with I/O outstanding\n");
5460 				rport = tgt->rport;
5461 				tgt->rport = NULL;
5462 				ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_LOGOUT_DELETED_RPORT);
5463 				spin_unlock_irqrestore(vhost->host->host_lock, flags);
5464 				if (rport)
5465 					fc_remote_port_delete(rport);
5466 				return;
5467 			}
5468 		}
5469 
5470 		if (vhost->state == IBMVFC_INITIALIZING) {
5471 			if (vhost->action == IBMVFC_HOST_ACTION_TGT_DEL_FAILED) {
5472 				if (vhost->reinit) {
5473 					vhost->reinit = 0;
5474 					scsi_block_requests(vhost->host);
5475 					ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY);
5476 					spin_unlock_irqrestore(vhost->host->host_lock, flags);
5477 				} else {
5478 					ibmvfc_set_host_state(vhost, IBMVFC_ACTIVE);
5479 					ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_NONE);
5480 					wake_up(&vhost->init_wait_q);
5481 					schedule_work(&vhost->rport_add_work_q);
5482 					vhost->init_retries = 0;
5483 					spin_unlock_irqrestore(vhost->host->host_lock, flags);
5484 					scsi_unblock_requests(vhost->host);
5485 				}
5486 
5487 				return;
5488 			} else {
5489 				ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT);
5490 				vhost->job_step = ibmvfc_discover_targets;
5491 			}
5492 		} else {
5493 			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_NONE);
5494 			spin_unlock_irqrestore(vhost->host->host_lock, flags);
5495 			scsi_unblock_requests(vhost->host);
5496 			wake_up(&vhost->init_wait_q);
5497 			return;
5498 		}
5499 		break;
5500 	case IBMVFC_HOST_ACTION_ALLOC_TGTS:
5501 		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_INIT);
5502 		spin_unlock_irqrestore(vhost->host->host_lock, flags);
5503 		ibmvfc_alloc_targets(vhost);
5504 		spin_lock_irqsave(vhost->host->host_lock, flags);
5505 		break;
5506 	case IBMVFC_HOST_ACTION_TGT_INIT:
5507 		list_for_each_entry(tgt, &vhost->targets, queue) {
5508 			if (tgt->action == IBMVFC_TGT_ACTION_INIT) {
5509 				tgt->job_step(tgt);
5510 				break;
5511 			}
5512 		}
5513 
5514 		if (!ibmvfc_dev_init_to_do(vhost))
5515 			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_DEL_FAILED);
5516 		break;
5517 	default:
5518 		break;
5519 	}
5520 
5521 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
5522 }
5523 
5524 /**
5525  * ibmvfc_work - Do task level work
5526  * @data:		ibmvfc host struct
5527  *
5528  * Returns:
5529  *	zero
5530  **/
5531 static int ibmvfc_work(void *data)
5532 {
5533 	struct ibmvfc_host *vhost = data;
5534 	int rc;
5535 
5536 	set_user_nice(current, MIN_NICE);
5537 
5538 	while (1) {
5539 		rc = wait_event_interruptible(vhost->work_wait_q,
5540 					      ibmvfc_work_to_do(vhost));
5541 
5542 		BUG_ON(rc);
5543 
5544 		if (kthread_should_stop())
5545 			break;
5546 
5547 		ibmvfc_do_work(vhost);
5548 	}
5549 
5550 	ibmvfc_dbg(vhost, "ibmvfc kthread exiting...\n");
5551 	return 0;
5552 }
5553 
5554 /**
5555  * ibmvfc_alloc_queue - Allocate queue
5556  * @vhost:	ibmvfc host struct
5557  * @queue:	ibmvfc queue to allocate
5558  * @fmt:	queue format to allocate
5559  *
5560  * Returns:
5561  *	0 on success / non-zero on failure
5562  **/
5563 static int ibmvfc_alloc_queue(struct ibmvfc_host *vhost,
5564 			      struct ibmvfc_queue *queue,
5565 			      enum ibmvfc_msg_fmt fmt)
5566 {
5567 	struct device *dev = vhost->dev;
5568 	size_t fmt_size;
5569 	unsigned int pool_size = 0;
5570 
5571 	ENTER;
5572 	spin_lock_init(&queue->_lock);
5573 	queue->q_lock = &queue->_lock;
5574 
5575 	switch (fmt) {
5576 	case IBMVFC_CRQ_FMT:
5577 		fmt_size = sizeof(*queue->msgs.crq);
5578 		pool_size = max_requests + IBMVFC_NUM_INTERNAL_REQ;
5579 		break;
5580 	case IBMVFC_ASYNC_FMT:
5581 		fmt_size = sizeof(*queue->msgs.async);
5582 		break;
5583 	case IBMVFC_SUB_CRQ_FMT:
5584 		fmt_size = sizeof(*queue->msgs.scrq);
5585 		/* We need one extra event for Cancel Commands */
5586 		pool_size = max_requests + 1;
5587 		break;
5588 	default:
5589 		dev_warn(dev, "Unknown command/response queue message format: %d\n", fmt);
5590 		return -EINVAL;
5591 	}
5592 
5593 	if (ibmvfc_init_event_pool(vhost, queue, pool_size)) {
5594 		dev_err(dev, "Couldn't initialize event pool.\n");
5595 		return -ENOMEM;
5596 	}
5597 
5598 	queue->msgs.handle = (void *)get_zeroed_page(GFP_KERNEL);
5599 	if (!queue->msgs.handle)
5600 		return -ENOMEM;
5601 
5602 	queue->msg_token = dma_map_single(dev, queue->msgs.handle, PAGE_SIZE,
5603 					  DMA_BIDIRECTIONAL);
5604 
5605 	if (dma_mapping_error(dev, queue->msg_token)) {
5606 		free_page((unsigned long)queue->msgs.handle);
5607 		queue->msgs.handle = NULL;
5608 		return -ENOMEM;
5609 	}
5610 
5611 	queue->cur = 0;
5612 	queue->fmt = fmt;
5613 	queue->size = PAGE_SIZE / fmt_size;
5614 	return 0;
5615 }
5616 
5617 /**
5618  * ibmvfc_init_crq - Initializes and registers CRQ with hypervisor
5619  * @vhost:	ibmvfc host struct
5620  *
5621  * Allocates a page for messages, maps it for dma, and registers
5622  * the crq with the hypervisor.
5623  *
5624  * Return value:
5625  *	zero on success / other on failure
5626  **/
5627 static int ibmvfc_init_crq(struct ibmvfc_host *vhost)
5628 {
5629 	int rc, retrc = -ENOMEM;
5630 	struct device *dev = vhost->dev;
5631 	struct vio_dev *vdev = to_vio_dev(dev);
5632 	struct ibmvfc_queue *crq = &vhost->crq;
5633 
5634 	ENTER;
5635 	if (ibmvfc_alloc_queue(vhost, crq, IBMVFC_CRQ_FMT))
5636 		return -ENOMEM;
5637 
5638 	retrc = rc = plpar_hcall_norets(H_REG_CRQ, vdev->unit_address,
5639 					crq->msg_token, PAGE_SIZE);
5640 
5641 	if (rc == H_RESOURCE)
5642 		/* maybe kexecing and resource is busy. try a reset */
5643 		retrc = rc = ibmvfc_reset_crq(vhost);
5644 
5645 	if (rc == H_CLOSED)
5646 		dev_warn(dev, "Partner adapter not ready\n");
5647 	else if (rc) {
5648 		dev_warn(dev, "Error %d opening adapter\n", rc);
5649 		goto reg_crq_failed;
5650 	}
5651 
5652 	retrc = 0;
5653 
5654 	tasklet_init(&vhost->tasklet, (void *)ibmvfc_tasklet, (unsigned long)vhost);
5655 
5656 	if ((rc = request_irq(vdev->irq, ibmvfc_interrupt, 0, IBMVFC_NAME, vhost))) {
5657 		dev_err(dev, "Couldn't register irq 0x%x. rc=%d\n", vdev->irq, rc);
5658 		goto req_irq_failed;
5659 	}
5660 
5661 	if ((rc = vio_enable_interrupts(vdev))) {
5662 		dev_err(dev, "Error %d enabling interrupts\n", rc);
5663 		goto req_irq_failed;
5664 	}
5665 
5666 	LEAVE;
5667 	return retrc;
5668 
5669 req_irq_failed:
5670 	tasklet_kill(&vhost->tasklet);
5671 	do {
5672 		rc = plpar_hcall_norets(H_FREE_CRQ, vdev->unit_address);
5673 	} while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
5674 reg_crq_failed:
5675 	ibmvfc_free_queue(vhost, crq);
5676 	return retrc;
5677 }
5678 
5679 static int ibmvfc_register_scsi_channel(struct ibmvfc_host *vhost,
5680 				  int index)
5681 {
5682 	struct device *dev = vhost->dev;
5683 	struct vio_dev *vdev = to_vio_dev(dev);
5684 	struct ibmvfc_queue *scrq = &vhost->scsi_scrqs.scrqs[index];
5685 	int rc = -ENOMEM;
5686 
5687 	ENTER;
5688 
5689 	if (ibmvfc_alloc_queue(vhost, scrq, IBMVFC_SUB_CRQ_FMT))
5690 		return -ENOMEM;
5691 
5692 	rc = h_reg_sub_crq(vdev->unit_address, scrq->msg_token, PAGE_SIZE,
5693 			   &scrq->cookie, &scrq->hw_irq);
5694 
5695 	/* H_CLOSED indicates successful register, but no CRQ partner */
5696 	if (rc && rc != H_CLOSED) {
5697 		dev_warn(dev, "Error registering sub-crq: %d\n", rc);
5698 		if (rc == H_PARAMETER)
5699 			dev_warn_once(dev, "Firmware may not support MQ\n");
5700 		goto reg_failed;
5701 	}
5702 
5703 	scrq->irq = irq_create_mapping(NULL, scrq->hw_irq);
5704 
5705 	if (!scrq->irq) {
5706 		rc = -EINVAL;
5707 		dev_err(dev, "Error mapping sub-crq[%d] irq\n", index);
5708 		goto irq_failed;
5709 	}
5710 
5711 	snprintf(scrq->name, sizeof(scrq->name), "ibmvfc-%x-scsi%d",
5712 		 vdev->unit_address, index);
5713 	rc = request_irq(scrq->irq, ibmvfc_interrupt_scsi, 0, scrq->name, scrq);
5714 
5715 	if (rc) {
5716 		dev_err(dev, "Couldn't register sub-crq[%d] irq\n", index);
5717 		irq_dispose_mapping(scrq->irq);
5718 		goto irq_failed;
5719 	}
5720 
5721 	scrq->hwq_id = index;
5722 	scrq->vhost = vhost;
5723 
5724 	LEAVE;
5725 	return 0;
5726 
5727 irq_failed:
5728 	do {
5729 		rc = plpar_hcall_norets(H_FREE_SUB_CRQ, vdev->unit_address, scrq->cookie);
5730 	} while (rtas_busy_delay(rc));
5731 reg_failed:
5732 	ibmvfc_free_queue(vhost, scrq);
5733 	LEAVE;
5734 	return rc;
5735 }
5736 
5737 static void ibmvfc_deregister_scsi_channel(struct ibmvfc_host *vhost, int index)
5738 {
5739 	struct device *dev = vhost->dev;
5740 	struct vio_dev *vdev = to_vio_dev(dev);
5741 	struct ibmvfc_queue *scrq = &vhost->scsi_scrqs.scrqs[index];
5742 	long rc;
5743 
5744 	ENTER;
5745 
5746 	free_irq(scrq->irq, scrq);
5747 	irq_dispose_mapping(scrq->irq);
5748 	scrq->irq = 0;
5749 
5750 	do {
5751 		rc = plpar_hcall_norets(H_FREE_SUB_CRQ, vdev->unit_address,
5752 					scrq->cookie);
5753 	} while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
5754 
5755 	if (rc)
5756 		dev_err(dev, "Failed to free sub-crq[%d]: rc=%ld\n", index, rc);
5757 
5758 	ibmvfc_free_queue(vhost, scrq);
5759 	LEAVE;
5760 }
5761 
5762 static void ibmvfc_init_sub_crqs(struct ibmvfc_host *vhost)
5763 {
5764 	int i, j;
5765 
5766 	ENTER;
5767 	if (!vhost->mq_enabled)
5768 		return;
5769 
5770 	vhost->scsi_scrqs.scrqs = kcalloc(nr_scsi_hw_queues,
5771 					  sizeof(*vhost->scsi_scrqs.scrqs),
5772 					  GFP_KERNEL);
5773 	if (!vhost->scsi_scrqs.scrqs) {
5774 		vhost->do_enquiry = 0;
5775 		return;
5776 	}
5777 
5778 	for (i = 0; i < nr_scsi_hw_queues; i++) {
5779 		if (ibmvfc_register_scsi_channel(vhost, i)) {
5780 			for (j = i; j > 0; j--)
5781 				ibmvfc_deregister_scsi_channel(vhost, j - 1);
5782 			kfree(vhost->scsi_scrqs.scrqs);
5783 			vhost->scsi_scrqs.scrqs = NULL;
5784 			vhost->scsi_scrqs.active_queues = 0;
5785 			vhost->do_enquiry = 0;
5786 			break;
5787 		}
5788 	}
5789 
5790 	LEAVE;
5791 }
5792 
5793 static void ibmvfc_release_sub_crqs(struct ibmvfc_host *vhost)
5794 {
5795 	int i;
5796 
5797 	ENTER;
5798 	if (!vhost->scsi_scrqs.scrqs)
5799 		return;
5800 
5801 	for (i = 0; i < nr_scsi_hw_queues; i++)
5802 		ibmvfc_deregister_scsi_channel(vhost, i);
5803 
5804 	kfree(vhost->scsi_scrqs.scrqs);
5805 	vhost->scsi_scrqs.scrqs = NULL;
5806 	vhost->scsi_scrqs.active_queues = 0;
5807 	LEAVE;
5808 }
5809 
5810 /**
5811  * ibmvfc_free_mem - Free memory for vhost
5812  * @vhost:	ibmvfc host struct
5813  *
5814  * Return value:
5815  * 	none
5816  **/
5817 static void ibmvfc_free_mem(struct ibmvfc_host *vhost)
5818 {
5819 	struct ibmvfc_queue *async_q = &vhost->async_crq;
5820 
5821 	ENTER;
5822 	mempool_destroy(vhost->tgt_pool);
5823 	kfree(vhost->trace);
5824 	dma_free_coherent(vhost->dev, vhost->disc_buf_sz, vhost->disc_buf,
5825 			  vhost->disc_buf_dma);
5826 	dma_free_coherent(vhost->dev, sizeof(*vhost->login_buf),
5827 			  vhost->login_buf, vhost->login_buf_dma);
5828 	dma_free_coherent(vhost->dev, sizeof(*vhost->channel_setup_buf),
5829 			  vhost->channel_setup_buf, vhost->channel_setup_dma);
5830 	dma_pool_destroy(vhost->sg_pool);
5831 	ibmvfc_free_queue(vhost, async_q);
5832 	LEAVE;
5833 }
5834 
5835 /**
5836  * ibmvfc_alloc_mem - Allocate memory for vhost
5837  * @vhost:	ibmvfc host struct
5838  *
5839  * Return value:
5840  * 	0 on success / non-zero on failure
5841  **/
5842 static int ibmvfc_alloc_mem(struct ibmvfc_host *vhost)
5843 {
5844 	struct ibmvfc_queue *async_q = &vhost->async_crq;
5845 	struct device *dev = vhost->dev;
5846 
5847 	ENTER;
5848 	if (ibmvfc_alloc_queue(vhost, async_q, IBMVFC_ASYNC_FMT)) {
5849 		dev_err(dev, "Couldn't allocate/map async queue.\n");
5850 		goto nomem;
5851 	}
5852 
5853 	vhost->sg_pool = dma_pool_create(IBMVFC_NAME, dev,
5854 					 SG_ALL * sizeof(struct srp_direct_buf),
5855 					 sizeof(struct srp_direct_buf), 0);
5856 
5857 	if (!vhost->sg_pool) {
5858 		dev_err(dev, "Failed to allocate sg pool\n");
5859 		goto unmap_async_crq;
5860 	}
5861 
5862 	vhost->login_buf = dma_alloc_coherent(dev, sizeof(*vhost->login_buf),
5863 					      &vhost->login_buf_dma, GFP_KERNEL);
5864 
5865 	if (!vhost->login_buf) {
5866 		dev_err(dev, "Couldn't allocate NPIV login buffer\n");
5867 		goto free_sg_pool;
5868 	}
5869 
5870 	vhost->disc_buf_sz = sizeof(*vhost->disc_buf) * max_targets;
5871 	vhost->disc_buf = dma_alloc_coherent(dev, vhost->disc_buf_sz,
5872 					     &vhost->disc_buf_dma, GFP_KERNEL);
5873 
5874 	if (!vhost->disc_buf) {
5875 		dev_err(dev, "Couldn't allocate Discover Targets buffer\n");
5876 		goto free_login_buffer;
5877 	}
5878 
5879 	vhost->trace = kcalloc(IBMVFC_NUM_TRACE_ENTRIES,
5880 			       sizeof(struct ibmvfc_trace_entry), GFP_KERNEL);
5881 	atomic_set(&vhost->trace_index, -1);
5882 
5883 	if (!vhost->trace)
5884 		goto free_disc_buffer;
5885 
5886 	vhost->tgt_pool = mempool_create_kmalloc_pool(IBMVFC_TGT_MEMPOOL_SZ,
5887 						      sizeof(struct ibmvfc_target));
5888 
5889 	if (!vhost->tgt_pool) {
5890 		dev_err(dev, "Couldn't allocate target memory pool\n");
5891 		goto free_trace;
5892 	}
5893 
5894 	vhost->channel_setup_buf = dma_alloc_coherent(dev, sizeof(*vhost->channel_setup_buf),
5895 						      &vhost->channel_setup_dma,
5896 						      GFP_KERNEL);
5897 
5898 	if (!vhost->channel_setup_buf) {
5899 		dev_err(dev, "Couldn't allocate Channel Setup buffer\n");
5900 		goto free_tgt_pool;
5901 	}
5902 
5903 	LEAVE;
5904 	return 0;
5905 
5906 free_tgt_pool:
5907 	mempool_destroy(vhost->tgt_pool);
5908 free_trace:
5909 	kfree(vhost->trace);
5910 free_disc_buffer:
5911 	dma_free_coherent(dev, vhost->disc_buf_sz, vhost->disc_buf,
5912 			  vhost->disc_buf_dma);
5913 free_login_buffer:
5914 	dma_free_coherent(dev, sizeof(*vhost->login_buf),
5915 			  vhost->login_buf, vhost->login_buf_dma);
5916 free_sg_pool:
5917 	dma_pool_destroy(vhost->sg_pool);
5918 unmap_async_crq:
5919 	ibmvfc_free_queue(vhost, async_q);
5920 nomem:
5921 	LEAVE;
5922 	return -ENOMEM;
5923 }
5924 
5925 /**
5926  * ibmvfc_rport_add_thread - Worker thread for rport adds
5927  * @work:	work struct
5928  *
5929  **/
5930 static void ibmvfc_rport_add_thread(struct work_struct *work)
5931 {
5932 	struct ibmvfc_host *vhost = container_of(work, struct ibmvfc_host,
5933 						 rport_add_work_q);
5934 	struct ibmvfc_target *tgt;
5935 	struct fc_rport *rport;
5936 	unsigned long flags;
5937 	int did_work;
5938 
5939 	ENTER;
5940 	spin_lock_irqsave(vhost->host->host_lock, flags);
5941 	do {
5942 		did_work = 0;
5943 		if (vhost->state != IBMVFC_ACTIVE)
5944 			break;
5945 
5946 		list_for_each_entry(tgt, &vhost->targets, queue) {
5947 			if (tgt->add_rport) {
5948 				did_work = 1;
5949 				tgt->add_rport = 0;
5950 				kref_get(&tgt->kref);
5951 				rport = tgt->rport;
5952 				if (!rport) {
5953 					spin_unlock_irqrestore(vhost->host->host_lock, flags);
5954 					ibmvfc_tgt_add_rport(tgt);
5955 				} else if (get_device(&rport->dev)) {
5956 					spin_unlock_irqrestore(vhost->host->host_lock, flags);
5957 					tgt_dbg(tgt, "Setting rport roles\n");
5958 					fc_remote_port_rolechg(rport, tgt->ids.roles);
5959 					put_device(&rport->dev);
5960 				} else {
5961 					spin_unlock_irqrestore(vhost->host->host_lock, flags);
5962 				}
5963 
5964 				kref_put(&tgt->kref, ibmvfc_release_tgt);
5965 				spin_lock_irqsave(vhost->host->host_lock, flags);
5966 				break;
5967 			}
5968 		}
5969 	} while(did_work);
5970 
5971 	if (vhost->state == IBMVFC_ACTIVE)
5972 		vhost->scan_complete = 1;
5973 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
5974 	LEAVE;
5975 }
5976 
5977 /**
5978  * ibmvfc_probe - Adapter hot plug add entry point
5979  * @vdev:	vio device struct
5980  * @id:	vio device id struct
5981  *
5982  * Return value:
5983  * 	0 on success / non-zero on failure
5984  **/
5985 static int ibmvfc_probe(struct vio_dev *vdev, const struct vio_device_id *id)
5986 {
5987 	struct ibmvfc_host *vhost;
5988 	struct Scsi_Host *shost;
5989 	struct device *dev = &vdev->dev;
5990 	int rc = -ENOMEM;
5991 	unsigned int max_scsi_queues = IBMVFC_MAX_SCSI_QUEUES;
5992 
5993 	ENTER;
5994 	shost = scsi_host_alloc(&driver_template, sizeof(*vhost));
5995 	if (!shost) {
5996 		dev_err(dev, "Couldn't allocate host data\n");
5997 		goto out;
5998 	}
5999 
6000 	shost->transportt = ibmvfc_transport_template;
6001 	shost->can_queue = max_requests;
6002 	shost->max_lun = max_lun;
6003 	shost->max_id = max_targets;
6004 	shost->max_sectors = IBMVFC_MAX_SECTORS;
6005 	shost->max_cmd_len = IBMVFC_MAX_CDB_LEN;
6006 	shost->unique_id = shost->host_no;
6007 	shost->nr_hw_queues = mq_enabled ? min(max_scsi_queues, nr_scsi_hw_queues) : 1;
6008 
6009 	vhost = shost_priv(shost);
6010 	INIT_LIST_HEAD(&vhost->targets);
6011 	INIT_LIST_HEAD(&vhost->purge);
6012 	sprintf(vhost->name, IBMVFC_NAME);
6013 	vhost->host = shost;
6014 	vhost->dev = dev;
6015 	vhost->partition_number = -1;
6016 	vhost->log_level = log_level;
6017 	vhost->task_set = 1;
6018 
6019 	vhost->mq_enabled = mq_enabled;
6020 	vhost->client_scsi_channels = min(shost->nr_hw_queues, nr_scsi_channels);
6021 	vhost->using_channels = 0;
6022 	vhost->do_enquiry = 1;
6023 
6024 	strcpy(vhost->partition_name, "UNKNOWN");
6025 	init_waitqueue_head(&vhost->work_wait_q);
6026 	init_waitqueue_head(&vhost->init_wait_q);
6027 	INIT_WORK(&vhost->rport_add_work_q, ibmvfc_rport_add_thread);
6028 	mutex_init(&vhost->passthru_mutex);
6029 
6030 	if ((rc = ibmvfc_alloc_mem(vhost)))
6031 		goto free_scsi_host;
6032 
6033 	vhost->work_thread = kthread_run(ibmvfc_work, vhost, "%s_%d", IBMVFC_NAME,
6034 					 shost->host_no);
6035 
6036 	if (IS_ERR(vhost->work_thread)) {
6037 		dev_err(dev, "Couldn't create kernel thread: %ld\n",
6038 			PTR_ERR(vhost->work_thread));
6039 		rc = PTR_ERR(vhost->work_thread);
6040 		goto free_host_mem;
6041 	}
6042 
6043 	if ((rc = ibmvfc_init_crq(vhost))) {
6044 		dev_err(dev, "Couldn't initialize crq. rc=%d\n", rc);
6045 		goto kill_kthread;
6046 	}
6047 
6048 	if ((rc = scsi_add_host(shost, dev)))
6049 		goto release_crq;
6050 
6051 	fc_host_dev_loss_tmo(shost) = IBMVFC_DEV_LOSS_TMO;
6052 
6053 	if ((rc = ibmvfc_create_trace_file(&shost->shost_dev.kobj,
6054 					   &ibmvfc_trace_attr))) {
6055 		dev_err(dev, "Failed to create trace file. rc=%d\n", rc);
6056 		goto remove_shost;
6057 	}
6058 
6059 	ibmvfc_init_sub_crqs(vhost);
6060 
6061 	if (shost_to_fc_host(shost)->rqst_q)
6062 		blk_queue_max_segments(shost_to_fc_host(shost)->rqst_q, 1);
6063 	dev_set_drvdata(dev, vhost);
6064 	spin_lock(&ibmvfc_driver_lock);
6065 	list_add_tail(&vhost->queue, &ibmvfc_head);
6066 	spin_unlock(&ibmvfc_driver_lock);
6067 
6068 	ibmvfc_send_crq_init(vhost);
6069 	scsi_scan_host(shost);
6070 	return 0;
6071 
6072 remove_shost:
6073 	scsi_remove_host(shost);
6074 release_crq:
6075 	ibmvfc_release_crq_queue(vhost);
6076 kill_kthread:
6077 	kthread_stop(vhost->work_thread);
6078 free_host_mem:
6079 	ibmvfc_free_mem(vhost);
6080 free_scsi_host:
6081 	scsi_host_put(shost);
6082 out:
6083 	LEAVE;
6084 	return rc;
6085 }
6086 
6087 /**
6088  * ibmvfc_remove - Adapter hot plug remove entry point
6089  * @vdev:	vio device struct
6090  *
6091  * Return value:
6092  * 	0
6093  **/
6094 static void ibmvfc_remove(struct vio_dev *vdev)
6095 {
6096 	struct ibmvfc_host *vhost = dev_get_drvdata(&vdev->dev);
6097 	LIST_HEAD(purge);
6098 	unsigned long flags;
6099 
6100 	ENTER;
6101 	ibmvfc_remove_trace_file(&vhost->host->shost_dev.kobj, &ibmvfc_trace_attr);
6102 
6103 	spin_lock_irqsave(vhost->host->host_lock, flags);
6104 	ibmvfc_link_down(vhost, IBMVFC_HOST_OFFLINE);
6105 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
6106 
6107 	ibmvfc_wait_while_resetting(vhost);
6108 	kthread_stop(vhost->work_thread);
6109 	fc_remove_host(vhost->host);
6110 	scsi_remove_host(vhost->host);
6111 
6112 	spin_lock_irqsave(vhost->host->host_lock, flags);
6113 	ibmvfc_purge_requests(vhost, DID_ERROR);
6114 	list_splice_init(&vhost->purge, &purge);
6115 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
6116 	ibmvfc_complete_purge(&purge);
6117 	ibmvfc_release_sub_crqs(vhost);
6118 	ibmvfc_release_crq_queue(vhost);
6119 
6120 	ibmvfc_free_mem(vhost);
6121 	spin_lock(&ibmvfc_driver_lock);
6122 	list_del(&vhost->queue);
6123 	spin_unlock(&ibmvfc_driver_lock);
6124 	scsi_host_put(vhost->host);
6125 	LEAVE;
6126 }
6127 
6128 /**
6129  * ibmvfc_resume - Resume from suspend
6130  * @dev:	device struct
6131  *
6132  * We may have lost an interrupt across suspend/resume, so kick the
6133  * interrupt handler
6134  *
6135  */
6136 static int ibmvfc_resume(struct device *dev)
6137 {
6138 	unsigned long flags;
6139 	struct ibmvfc_host *vhost = dev_get_drvdata(dev);
6140 	struct vio_dev *vdev = to_vio_dev(dev);
6141 
6142 	spin_lock_irqsave(vhost->host->host_lock, flags);
6143 	vio_disable_interrupts(vdev);
6144 	tasklet_schedule(&vhost->tasklet);
6145 	spin_unlock_irqrestore(vhost->host->host_lock, flags);
6146 	return 0;
6147 }
6148 
6149 /**
6150  * ibmvfc_get_desired_dma - Calculate DMA resources needed by the driver
6151  * @vdev:	vio device struct
6152  *
6153  * Return value:
6154  *	Number of bytes the driver will need to DMA map at the same time in
6155  *	order to perform well.
6156  */
6157 static unsigned long ibmvfc_get_desired_dma(struct vio_dev *vdev)
6158 {
6159 	unsigned long pool_dma = max_requests * sizeof(union ibmvfc_iu);
6160 	return pool_dma + ((512 * 1024) * driver_template.cmd_per_lun);
6161 }
6162 
6163 static const struct vio_device_id ibmvfc_device_table[] = {
6164 	{"fcp", "IBM,vfc-client"},
6165 	{ "", "" }
6166 };
6167 MODULE_DEVICE_TABLE(vio, ibmvfc_device_table);
6168 
6169 static const struct dev_pm_ops ibmvfc_pm_ops = {
6170 	.resume = ibmvfc_resume
6171 };
6172 
6173 static struct vio_driver ibmvfc_driver = {
6174 	.id_table = ibmvfc_device_table,
6175 	.probe = ibmvfc_probe,
6176 	.remove = ibmvfc_remove,
6177 	.get_desired_dma = ibmvfc_get_desired_dma,
6178 	.name = IBMVFC_NAME,
6179 	.pm = &ibmvfc_pm_ops,
6180 };
6181 
6182 static struct fc_function_template ibmvfc_transport_functions = {
6183 	.show_host_fabric_name = 1,
6184 	.show_host_node_name = 1,
6185 	.show_host_port_name = 1,
6186 	.show_host_supported_classes = 1,
6187 	.show_host_port_type = 1,
6188 	.show_host_port_id = 1,
6189 	.show_host_maxframe_size = 1,
6190 
6191 	.get_host_port_state = ibmvfc_get_host_port_state,
6192 	.show_host_port_state = 1,
6193 
6194 	.get_host_speed = ibmvfc_get_host_speed,
6195 	.show_host_speed = 1,
6196 
6197 	.issue_fc_host_lip = ibmvfc_issue_fc_host_lip,
6198 	.terminate_rport_io = ibmvfc_terminate_rport_io,
6199 
6200 	.show_rport_maxframe_size = 1,
6201 	.show_rport_supported_classes = 1,
6202 
6203 	.set_rport_dev_loss_tmo = ibmvfc_set_rport_dev_loss_tmo,
6204 	.show_rport_dev_loss_tmo = 1,
6205 
6206 	.get_starget_node_name = ibmvfc_get_starget_node_name,
6207 	.show_starget_node_name = 1,
6208 
6209 	.get_starget_port_name = ibmvfc_get_starget_port_name,
6210 	.show_starget_port_name = 1,
6211 
6212 	.get_starget_port_id = ibmvfc_get_starget_port_id,
6213 	.show_starget_port_id = 1,
6214 
6215 	.bsg_request = ibmvfc_bsg_request,
6216 	.bsg_timeout = ibmvfc_bsg_timeout,
6217 };
6218 
6219 /**
6220  * ibmvfc_module_init - Initialize the ibmvfc module
6221  *
6222  * Return value:
6223  * 	0 on success / other on failure
6224  **/
6225 static int __init ibmvfc_module_init(void)
6226 {
6227 	int rc;
6228 
6229 	if (!firmware_has_feature(FW_FEATURE_VIO))
6230 		return -ENODEV;
6231 
6232 	printk(KERN_INFO IBMVFC_NAME": IBM Virtual Fibre Channel Driver version: %s %s\n",
6233 	       IBMVFC_DRIVER_VERSION, IBMVFC_DRIVER_DATE);
6234 
6235 	ibmvfc_transport_template = fc_attach_transport(&ibmvfc_transport_functions);
6236 	if (!ibmvfc_transport_template)
6237 		return -ENOMEM;
6238 
6239 	rc = vio_register_driver(&ibmvfc_driver);
6240 	if (rc)
6241 		fc_release_transport(ibmvfc_transport_template);
6242 	return rc;
6243 }
6244 
6245 /**
6246  * ibmvfc_module_exit - Teardown the ibmvfc module
6247  *
6248  * Return value:
6249  * 	nothing
6250  **/
6251 static void __exit ibmvfc_module_exit(void)
6252 {
6253 	vio_unregister_driver(&ibmvfc_driver);
6254 	fc_release_transport(ibmvfc_transport_template);
6255 }
6256 
6257 module_init(ibmvfc_module_init);
6258 module_exit(ibmvfc_module_exit);
6259