ibmvfc.c revision 039a08981a49e05f09db969cdd3f38f05a5df46f
1/*
2 * ibmvfc.c -- driver for IBM Power Virtual Fibre Channel Adapter
3 *
4 * Written By: Brian King <brking@linux.vnet.ibm.com>, IBM Corporation
5 *
6 * Copyright (C) IBM Corporation, 2008
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
21 *
22 */
23
24#include <linux/module.h>
25#include <linux/moduleparam.h>
26#include <linux/dma-mapping.h>
27#include <linux/dmapool.h>
28#include <linux/delay.h>
29#include <linux/interrupt.h>
30#include <linux/kthread.h>
31#include <linux/of.h>
32#include <linux/stringify.h>
33#include <asm/firmware.h>
34#include <asm/irq.h>
35#include <asm/vio.h>
36#include <scsi/scsi.h>
37#include <scsi/scsi_cmnd.h>
38#include <scsi/scsi_host.h>
39#include <scsi/scsi_device.h>
40#include <scsi/scsi_tcq.h>
41#include <scsi/scsi_transport_fc.h>
42#include "ibmvfc.h"
43
44static unsigned int init_timeout = IBMVFC_INIT_TIMEOUT;
45static unsigned int default_timeout = IBMVFC_DEFAULT_TIMEOUT;
46static unsigned int max_lun = IBMVFC_MAX_LUN;
47static unsigned int max_targets = IBMVFC_MAX_TARGETS;
48static unsigned int max_requests = IBMVFC_MAX_REQUESTS_DEFAULT;
49static unsigned int disc_threads = IBMVFC_MAX_DISC_THREADS;
50static unsigned int dev_loss_tmo = IBMVFC_DEV_LOSS_TMO;
51static unsigned int ibmvfc_debug = IBMVFC_DEBUG;
52static unsigned int log_level = IBMVFC_DEFAULT_LOG_LEVEL;
53static LIST_HEAD(ibmvfc_head);
54static DEFINE_SPINLOCK(ibmvfc_driver_lock);
55static struct scsi_transport_template *ibmvfc_transport_template;
56
57MODULE_DESCRIPTION("IBM Virtual Fibre Channel Driver");
58MODULE_AUTHOR("Brian King <brking@linux.vnet.ibm.com>");
59MODULE_LICENSE("GPL");
60MODULE_VERSION(IBMVFC_DRIVER_VERSION);
61
62module_param_named(init_timeout, init_timeout, uint, S_IRUGO | S_IWUSR);
63MODULE_PARM_DESC(init_timeout, "Initialization timeout in seconds. "
64		 "[Default=" __stringify(IBMVFC_INIT_TIMEOUT) "]");
65module_param_named(default_timeout, default_timeout, uint, S_IRUGO | S_IWUSR);
66MODULE_PARM_DESC(default_timeout,
67		 "Default timeout in seconds for initialization and EH commands. "
68		 "[Default=" __stringify(IBMVFC_DEFAULT_TIMEOUT) "]");
69module_param_named(max_requests, max_requests, uint, S_IRUGO);
70MODULE_PARM_DESC(max_requests, "Maximum requests for this adapter. "
71		 "[Default=" __stringify(IBMVFC_MAX_REQUESTS_DEFAULT) "]");
72module_param_named(max_lun, max_lun, uint, S_IRUGO);
73MODULE_PARM_DESC(max_lun, "Maximum allowed LUN. "
74		 "[Default=" __stringify(IBMVFC_MAX_LUN) "]");
75module_param_named(max_targets, max_targets, uint, S_IRUGO);
76MODULE_PARM_DESC(max_targets, "Maximum allowed targets. "
77		 "[Default=" __stringify(IBMVFC_MAX_TARGETS) "]");
78module_param_named(disc_threads, disc_threads, uint, S_IRUGO | S_IWUSR);
79MODULE_PARM_DESC(disc_threads, "Number of device discovery threads to use. "
80		 "[Default=" __stringify(IBMVFC_MAX_DISC_THREADS) "]");
81module_param_named(debug, ibmvfc_debug, uint, S_IRUGO | S_IWUSR);
82MODULE_PARM_DESC(debug, "Enable driver debug information. "
83		 "[Default=" __stringify(IBMVFC_DEBUG) "]");
84module_param_named(dev_loss_tmo, dev_loss_tmo, uint, S_IRUGO | S_IWUSR);
85MODULE_PARM_DESC(dev_loss_tmo, "Maximum number of seconds that the FC "
86		 "transport should insulate the loss of a remote port. Once this "
87		 "value is exceeded, the scsi target is removed. "
88		 "[Default=" __stringify(IBMVFC_DEV_LOSS_TMO) "]");
89module_param_named(log_level, log_level, uint, 0);
90MODULE_PARM_DESC(log_level, "Set to 0 - 4 for increasing verbosity of device driver. "
91		 "[Default=" __stringify(IBMVFC_DEFAULT_LOG_LEVEL) "]");
92
93static const struct {
94	u16 status;
95	u16 error;
96	u8 result;
97	u8 retry;
98	int log;
99	char *name;
100} cmd_status [] = {
101	{ IBMVFC_FABRIC_MAPPED, IBMVFC_UNABLE_TO_ESTABLISH, DID_ERROR, 1, 1, "unable to establish" },
102	{ IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_FAULT, DID_OK, 1, 0, "transport fault" },
103	{ IBMVFC_FABRIC_MAPPED, IBMVFC_CMD_TIMEOUT, DID_TIME_OUT, 1, 1, "command timeout" },
104	{ IBMVFC_FABRIC_MAPPED, IBMVFC_ENETDOWN, DID_TRANSPORT_DISRUPTED, 1, 1, "network down" },
105	{ IBMVFC_FABRIC_MAPPED, IBMVFC_HW_FAILURE, DID_ERROR, 1, 1, "hardware failure" },
106	{ IBMVFC_FABRIC_MAPPED, IBMVFC_LINK_DOWN_ERR, DID_REQUEUE, 0, 0, "link down" },
107	{ IBMVFC_FABRIC_MAPPED, IBMVFC_LINK_DEAD_ERR, DID_ERROR, 0, 0, "link dead" },
108	{ IBMVFC_FABRIC_MAPPED, IBMVFC_UNABLE_TO_REGISTER, DID_ERROR, 1, 1, "unable to register" },
109	{ IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_BUSY, DID_BUS_BUSY, 1, 0, "transport busy" },
110	{ IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_DEAD, DID_ERROR, 0, 1, "transport dead" },
111	{ IBMVFC_FABRIC_MAPPED, IBMVFC_CONFIG_ERROR, DID_ERROR, 1, 1, "configuration error" },
112	{ IBMVFC_FABRIC_MAPPED, IBMVFC_NAME_SERVER_FAIL, DID_ERROR, 1, 1, "name server failure" },
113	{ IBMVFC_FABRIC_MAPPED, IBMVFC_LINK_HALTED, DID_REQUEUE, 0, 0, "link halted" },
114	{ IBMVFC_FABRIC_MAPPED, IBMVFC_XPORT_GENERAL, DID_OK, 1, 0, "general transport error" },
115
116	{ IBMVFC_VIOS_FAILURE, IBMVFC_CRQ_FAILURE, DID_REQUEUE, 1, 1, "CRQ failure" },
117	{ IBMVFC_VIOS_FAILURE, IBMVFC_SW_FAILURE, DID_ERROR, 0, 1, "software failure" },
118	{ IBMVFC_VIOS_FAILURE, IBMVFC_INVALID_PARAMETER, DID_ERROR, 0, 1, "invalid parameter" },
119	{ IBMVFC_VIOS_FAILURE, IBMVFC_MISSING_PARAMETER, DID_ERROR, 0, 1, "missing parameter" },
120	{ IBMVFC_VIOS_FAILURE, IBMVFC_HOST_IO_BUS, DID_ERROR, 1, 1, "host I/O bus failure" },
121	{ IBMVFC_VIOS_FAILURE, IBMVFC_TRANS_CANCELLED, DID_ERROR, 0, 1, "transaction cancelled" },
122	{ IBMVFC_VIOS_FAILURE, IBMVFC_TRANS_CANCELLED_IMPLICIT, DID_ERROR, 0, 1, "transaction cancelled implicit" },
123	{ IBMVFC_VIOS_FAILURE, IBMVFC_INSUFFICIENT_RESOURCE, DID_REQUEUE, 1, 1, "insufficient resources" },
124	{ IBMVFC_VIOS_FAILURE, IBMVFC_PLOGI_REQUIRED, DID_ERROR, 0, 1, "port login required" },
125	{ IBMVFC_VIOS_FAILURE, IBMVFC_COMMAND_FAILED, DID_ERROR, 1, 1, "command failed" },
126
127	{ IBMVFC_FC_FAILURE, IBMVFC_INVALID_ELS_CMD_CODE, DID_ERROR, 0, 1, "invalid ELS command code" },
128	{ IBMVFC_FC_FAILURE, IBMVFC_INVALID_VERSION, DID_ERROR, 0, 1, "invalid version level" },
129	{ IBMVFC_FC_FAILURE, IBMVFC_LOGICAL_ERROR, DID_ERROR, 1, 1, "logical error" },
130	{ IBMVFC_FC_FAILURE, IBMVFC_INVALID_CT_IU_SIZE, DID_ERROR, 0, 1, "invalid CT_IU size" },
131	{ IBMVFC_FC_FAILURE, IBMVFC_LOGICAL_BUSY, DID_REQUEUE, 1, 0, "logical busy" },
132	{ IBMVFC_FC_FAILURE, IBMVFC_PROTOCOL_ERROR, DID_ERROR, 1, 1, "protocol error" },
133	{ IBMVFC_FC_FAILURE, IBMVFC_UNABLE_TO_PERFORM_REQ, DID_ERROR, 1, 1, "unable to perform request" },
134	{ IBMVFC_FC_FAILURE, IBMVFC_CMD_NOT_SUPPORTED, DID_ERROR, 0, 0, "command not supported" },
135	{ IBMVFC_FC_FAILURE, IBMVFC_SERVER_NOT_AVAIL, DID_ERROR, 0, 1, "server not available" },
136	{ IBMVFC_FC_FAILURE, IBMVFC_CMD_IN_PROGRESS, DID_ERROR, 0, 1, "command already in progress" },
137	{ IBMVFC_FC_FAILURE, IBMVFC_VENDOR_SPECIFIC, DID_ERROR, 1, 1, "vendor specific" },
138
139	{ IBMVFC_FC_SCSI_ERROR, 0, DID_OK, 1, 0, "SCSI error" },
140};
141
142static void ibmvfc_npiv_login(struct ibmvfc_host *);
143static void ibmvfc_tgt_send_prli(struct ibmvfc_target *);
144static void ibmvfc_tgt_send_plogi(struct ibmvfc_target *);
145static void ibmvfc_tgt_query_target(struct ibmvfc_target *);
146
147static const char *unknown_error = "unknown error";
148
149#ifdef CONFIG_SCSI_IBMVFC_TRACE
150/**
151 * ibmvfc_trc_start - Log a start trace entry
152 * @evt:		ibmvfc event struct
153 *
154 **/
155static void ibmvfc_trc_start(struct ibmvfc_event *evt)
156{
157	struct ibmvfc_host *vhost = evt->vhost;
158	struct ibmvfc_cmd *vfc_cmd = &evt->iu.cmd;
159	struct ibmvfc_mad_common *mad = &evt->iu.mad_common;
160	struct ibmvfc_trace_entry *entry;
161
162	entry = &vhost->trace[vhost->trace_index++];
163	entry->evt = evt;
164	entry->time = jiffies;
165	entry->fmt = evt->crq.format;
166	entry->type = IBMVFC_TRC_START;
167
168	switch (entry->fmt) {
169	case IBMVFC_CMD_FORMAT:
170		entry->op_code = vfc_cmd->iu.cdb[0];
171		entry->scsi_id = vfc_cmd->tgt_scsi_id;
172		entry->lun = scsilun_to_int(&vfc_cmd->iu.lun);
173		entry->tmf_flags = vfc_cmd->iu.tmf_flags;
174		entry->u.start.xfer_len = vfc_cmd->iu.xfer_len;
175		break;
176	case IBMVFC_MAD_FORMAT:
177		entry->op_code = mad->opcode;
178		break;
179	default:
180		break;
181	};
182}
183
184/**
185 * ibmvfc_trc_end - Log an end trace entry
186 * @evt:		ibmvfc event struct
187 *
188 **/
189static void ibmvfc_trc_end(struct ibmvfc_event *evt)
190{
191	struct ibmvfc_host *vhost = evt->vhost;
192	struct ibmvfc_cmd *vfc_cmd = &evt->xfer_iu->cmd;
193	struct ibmvfc_mad_common *mad = &evt->xfer_iu->mad_common;
194	struct ibmvfc_trace_entry *entry = &vhost->trace[vhost->trace_index++];
195
196	entry->evt = evt;
197	entry->time = jiffies;
198	entry->fmt = evt->crq.format;
199	entry->type = IBMVFC_TRC_END;
200
201	switch (entry->fmt) {
202	case IBMVFC_CMD_FORMAT:
203		entry->op_code = vfc_cmd->iu.cdb[0];
204		entry->scsi_id = vfc_cmd->tgt_scsi_id;
205		entry->lun = scsilun_to_int(&vfc_cmd->iu.lun);
206		entry->tmf_flags = vfc_cmd->iu.tmf_flags;
207		entry->u.end.status = vfc_cmd->status;
208		entry->u.end.error = vfc_cmd->error;
209		entry->u.end.fcp_rsp_flags = vfc_cmd->rsp.flags;
210		entry->u.end.rsp_code = vfc_cmd->rsp.data.info.rsp_code;
211		entry->u.end.scsi_status = vfc_cmd->rsp.scsi_status;
212		break;
213	case IBMVFC_MAD_FORMAT:
214		entry->op_code = mad->opcode;
215		entry->u.end.status = mad->status;
216		break;
217	default:
218		break;
219
220	};
221}
222
223#else
224#define ibmvfc_trc_start(evt) do { } while (0)
225#define ibmvfc_trc_end(evt) do { } while (0)
226#endif
227
228/**
229 * ibmvfc_get_err_index - Find the index into cmd_status for the fcp response
230 * @status:		status / error class
231 * @error:		error
232 *
233 * Return value:
234 *	index into cmd_status / -EINVAL on failure
235 **/
236static int ibmvfc_get_err_index(u16 status, u16 error)
237{
238	int i;
239
240	for (i = 0; i < ARRAY_SIZE(cmd_status); i++)
241		if ((cmd_status[i].status & status) == cmd_status[i].status &&
242		    cmd_status[i].error == error)
243			return i;
244
245	return -EINVAL;
246}
247
248/**
249 * ibmvfc_get_cmd_error - Find the error description for the fcp response
250 * @status:		status / error class
251 * @error:		error
252 *
253 * Return value:
254 *	error description string
255 **/
256static const char *ibmvfc_get_cmd_error(u16 status, u16 error)
257{
258	int rc = ibmvfc_get_err_index(status, error);
259	if (rc >= 0)
260		return cmd_status[rc].name;
261	return unknown_error;
262}
263
264/**
265 * ibmvfc_get_err_result - Find the scsi status to return for the fcp response
266 * @vfc_cmd:	ibmvfc command struct
267 *
268 * Return value:
269 *	SCSI result value to return for completed command
270 **/
271static int ibmvfc_get_err_result(struct ibmvfc_cmd *vfc_cmd)
272{
273	int err;
274	struct ibmvfc_fcp_rsp *rsp = &vfc_cmd->rsp;
275	int fc_rsp_len = rsp->fcp_rsp_len;
276
277	if ((rsp->flags & FCP_RSP_LEN_VALID) &&
278	    ((!fc_rsp_len && fc_rsp_len != 4 && fc_rsp_len != 8) ||
279	     rsp->data.info.rsp_code))
280		return DID_ERROR << 16;
281
282	err = ibmvfc_get_err_index(vfc_cmd->status, vfc_cmd->error);
283	if (err >= 0)
284		return rsp->scsi_status | (cmd_status[err].result << 16);
285	return rsp->scsi_status | (DID_ERROR << 16);
286}
287
288/**
289 * ibmvfc_retry_cmd - Determine if error status is retryable
290 * @status:		status / error class
291 * @error:		error
292 *
293 * Return value:
294 *	1 if error should be retried / 0 if it should not
295 **/
296static int ibmvfc_retry_cmd(u16 status, u16 error)
297{
298	int rc = ibmvfc_get_err_index(status, error);
299
300	if (rc >= 0)
301		return cmd_status[rc].retry;
302	return 1;
303}
304
305static const char *unknown_fc_explain = "unknown fc explain";
306
307static const struct {
308	u16 fc_explain;
309	char *name;
310} ls_explain [] = {
311	{ 0x00, "no additional explanation" },
312	{ 0x01, "service parameter error - options" },
313	{ 0x03, "service parameter error - initiator control" },
314	{ 0x05, "service parameter error - recipient control" },
315	{ 0x07, "service parameter error - received data field size" },
316	{ 0x09, "service parameter error - concurrent seq" },
317	{ 0x0B, "service parameter error - credit" },
318	{ 0x0D, "invalid N_Port/F_Port_Name" },
319	{ 0x0E, "invalid node/Fabric Name" },
320	{ 0x0F, "invalid common service parameters" },
321	{ 0x11, "invalid association header" },
322	{ 0x13, "association header required" },
323	{ 0x15, "invalid originator S_ID" },
324	{ 0x17, "invalid OX_ID-RX-ID combination" },
325	{ 0x19, "command (request) already in progress" },
326	{ 0x1E, "N_Port Login requested" },
327	{ 0x1F, "Invalid N_Port_ID" },
328};
329
330static const struct {
331	u16 fc_explain;
332	char *name;
333} gs_explain [] = {
334	{ 0x00, "no additional explanation" },
335	{ 0x01, "port identifier not registered" },
336	{ 0x02, "port name not registered" },
337	{ 0x03, "node name not registered" },
338	{ 0x04, "class of service not registered" },
339	{ 0x06, "initial process associator not registered" },
340	{ 0x07, "FC-4 TYPEs not registered" },
341	{ 0x08, "symbolic port name not registered" },
342	{ 0x09, "symbolic node name not registered" },
343	{ 0x0A, "port type not registered" },
344	{ 0xF0, "authorization exception" },
345	{ 0xF1, "authentication exception" },
346	{ 0xF2, "data base full" },
347	{ 0xF3, "data base empty" },
348	{ 0xF4, "processing request" },
349	{ 0xF5, "unable to verify connection" },
350	{ 0xF6, "devices not in a common zone" },
351};
352
353/**
354 * ibmvfc_get_ls_explain - Return the FC Explain description text
355 * @status:	FC Explain status
356 *
357 * Returns:
358 *	error string
359 **/
360static const char *ibmvfc_get_ls_explain(u16 status)
361{
362	int i;
363
364	for (i = 0; i < ARRAY_SIZE(ls_explain); i++)
365		if (ls_explain[i].fc_explain == status)
366			return ls_explain[i].name;
367
368	return unknown_fc_explain;
369}
370
371/**
372 * ibmvfc_get_gs_explain - Return the FC Explain description text
373 * @status:	FC Explain status
374 *
375 * Returns:
376 *	error string
377 **/
378static const char *ibmvfc_get_gs_explain(u16 status)
379{
380	int i;
381
382	for (i = 0; i < ARRAY_SIZE(gs_explain); i++)
383		if (gs_explain[i].fc_explain == status)
384			return gs_explain[i].name;
385
386	return unknown_fc_explain;
387}
388
389static const struct {
390	enum ibmvfc_fc_type fc_type;
391	char *name;
392} fc_type [] = {
393	{ IBMVFC_FABRIC_REJECT, "fabric reject" },
394	{ IBMVFC_PORT_REJECT, "port reject" },
395	{ IBMVFC_LS_REJECT, "ELS reject" },
396	{ IBMVFC_FABRIC_BUSY, "fabric busy" },
397	{ IBMVFC_PORT_BUSY, "port busy" },
398	{ IBMVFC_BASIC_REJECT, "basic reject" },
399};
400
401static const char *unknown_fc_type = "unknown fc type";
402
403/**
404 * ibmvfc_get_fc_type - Return the FC Type description text
405 * @status:	FC Type error status
406 *
407 * Returns:
408 *	error string
409 **/
410static const char *ibmvfc_get_fc_type(u16 status)
411{
412	int i;
413
414	for (i = 0; i < ARRAY_SIZE(fc_type); i++)
415		if (fc_type[i].fc_type == status)
416			return fc_type[i].name;
417
418	return unknown_fc_type;
419}
420
421/**
422 * ibmvfc_set_tgt_action - Set the next init action for the target
423 * @tgt:		ibmvfc target struct
424 * @action:		action to perform
425 *
426 **/
427static void ibmvfc_set_tgt_action(struct ibmvfc_target *tgt,
428				  enum ibmvfc_target_action action)
429{
430	switch (tgt->action) {
431	case IBMVFC_TGT_ACTION_DEL_RPORT:
432		break;
433	default:
434		tgt->action = action;
435		break;
436	}
437}
438
439/**
440 * ibmvfc_set_host_state - Set the state for the host
441 * @vhost:		ibmvfc host struct
442 * @state:		state to set host to
443 *
444 * Returns:
445 *	0 if state changed / non-zero if not changed
446 **/
447static int ibmvfc_set_host_state(struct ibmvfc_host *vhost,
448				  enum ibmvfc_host_state state)
449{
450	int rc = 0;
451
452	switch (vhost->state) {
453	case IBMVFC_HOST_OFFLINE:
454		rc = -EINVAL;
455		break;
456	default:
457		vhost->state = state;
458		break;
459	};
460
461	return rc;
462}
463
464/**
465 * ibmvfc_set_host_action - Set the next init action for the host
466 * @vhost:		ibmvfc host struct
467 * @action:		action to perform
468 *
469 **/
470static void ibmvfc_set_host_action(struct ibmvfc_host *vhost,
471				   enum ibmvfc_host_action action)
472{
473	switch (action) {
474	case IBMVFC_HOST_ACTION_ALLOC_TGTS:
475		if (vhost->action == IBMVFC_HOST_ACTION_INIT_WAIT)
476			vhost->action = action;
477		break;
478	case IBMVFC_HOST_ACTION_INIT_WAIT:
479		if (vhost->action == IBMVFC_HOST_ACTION_INIT)
480			vhost->action = action;
481		break;
482	case IBMVFC_HOST_ACTION_QUERY:
483		switch (vhost->action) {
484		case IBMVFC_HOST_ACTION_INIT_WAIT:
485		case IBMVFC_HOST_ACTION_NONE:
486		case IBMVFC_HOST_ACTION_TGT_ADD:
487			vhost->action = action;
488			break;
489		default:
490			break;
491		};
492		break;
493	case IBMVFC_HOST_ACTION_TGT_INIT:
494		if (vhost->action == IBMVFC_HOST_ACTION_ALLOC_TGTS)
495			vhost->action = action;
496		break;
497	case IBMVFC_HOST_ACTION_INIT:
498	case IBMVFC_HOST_ACTION_TGT_DEL:
499	case IBMVFC_HOST_ACTION_QUERY_TGTS:
500	case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
501	case IBMVFC_HOST_ACTION_TGT_ADD:
502	case IBMVFC_HOST_ACTION_NONE:
503	default:
504		vhost->action = action;
505		break;
506	};
507}
508
509/**
510 * ibmvfc_reinit_host - Re-start host initialization (no NPIV Login)
511 * @vhost:		ibmvfc host struct
512 *
513 * Return value:
514 *	nothing
515 **/
516static void ibmvfc_reinit_host(struct ibmvfc_host *vhost)
517{
518	if (vhost->action == IBMVFC_HOST_ACTION_NONE) {
519		if (!ibmvfc_set_host_state(vhost, IBMVFC_INITIALIZING)) {
520			scsi_block_requests(vhost->host);
521			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY);
522		}
523	} else
524		vhost->reinit = 1;
525
526	wake_up(&vhost->work_wait_q);
527}
528
529/**
530 * ibmvfc_link_down - Handle a link down event from the adapter
531 * @vhost:	ibmvfc host struct
532 * @state:	ibmvfc host state to enter
533 *
534 **/
535static void ibmvfc_link_down(struct ibmvfc_host *vhost,
536			     enum ibmvfc_host_state state)
537{
538	struct ibmvfc_target *tgt;
539
540	ENTER;
541	scsi_block_requests(vhost->host);
542	list_for_each_entry(tgt, &vhost->targets, queue)
543		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
544	ibmvfc_set_host_state(vhost, state);
545	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_DEL);
546	vhost->events_to_log |= IBMVFC_AE_LINKDOWN;
547	wake_up(&vhost->work_wait_q);
548	LEAVE;
549}
550
551/**
552 * ibmvfc_init_host - Start host initialization
553 * @vhost:		ibmvfc host struct
554 * @relogin:	is this a re-login?
555 *
556 * Return value:
557 *	nothing
558 **/
559static void ibmvfc_init_host(struct ibmvfc_host *vhost, int relogin)
560{
561	struct ibmvfc_target *tgt;
562
563	if (vhost->action == IBMVFC_HOST_ACTION_INIT_WAIT) {
564		if (++vhost->init_retries > IBMVFC_MAX_HOST_INIT_RETRIES) {
565			dev_err(vhost->dev,
566				"Host initialization retries exceeded. Taking adapter offline\n");
567			ibmvfc_link_down(vhost, IBMVFC_HOST_OFFLINE);
568			return;
569		}
570	}
571
572	if (!ibmvfc_set_host_state(vhost, IBMVFC_INITIALIZING)) {
573		if (!relogin) {
574			memset(vhost->async_crq.msgs, 0, PAGE_SIZE);
575			vhost->async_crq.cur = 0;
576		}
577
578		list_for_each_entry(tgt, &vhost->targets, queue)
579			tgt->need_login = 1;
580		scsi_block_requests(vhost->host);
581		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT);
582		vhost->job_step = ibmvfc_npiv_login;
583		wake_up(&vhost->work_wait_q);
584	}
585}
586
587/**
588 * ibmvfc_send_crq - Send a CRQ
589 * @vhost:	ibmvfc host struct
590 * @word1:	the first 64 bits of the data
591 * @word2:	the second 64 bits of the data
592 *
593 * Return value:
594 *	0 on success / other on failure
595 **/
596static int ibmvfc_send_crq(struct ibmvfc_host *vhost, u64 word1, u64 word2)
597{
598	struct vio_dev *vdev = to_vio_dev(vhost->dev);
599	return plpar_hcall_norets(H_SEND_CRQ, vdev->unit_address, word1, word2);
600}
601
602/**
603 * ibmvfc_send_crq_init - Send a CRQ init message
604 * @vhost:	ibmvfc host struct
605 *
606 * Return value:
607 *	0 on success / other on failure
608 **/
609static int ibmvfc_send_crq_init(struct ibmvfc_host *vhost)
610{
611	ibmvfc_dbg(vhost, "Sending CRQ init\n");
612	return ibmvfc_send_crq(vhost, 0xC001000000000000LL, 0);
613}
614
615/**
616 * ibmvfc_send_crq_init_complete - Send a CRQ init complete message
617 * @vhost:	ibmvfc host struct
618 *
619 * Return value:
620 *	0 on success / other on failure
621 **/
622static int ibmvfc_send_crq_init_complete(struct ibmvfc_host *vhost)
623{
624	ibmvfc_dbg(vhost, "Sending CRQ init complete\n");
625	return ibmvfc_send_crq(vhost, 0xC002000000000000LL, 0);
626}
627
628/**
629 * ibmvfc_release_crq_queue - Deallocates data and unregisters CRQ
630 * @vhost:	ibmvfc host struct
631 *
632 * Frees irq, deallocates a page for messages, unmaps dma, and unregisters
633 * the crq with the hypervisor.
634 **/
635static void ibmvfc_release_crq_queue(struct ibmvfc_host *vhost)
636{
637	long rc;
638	struct vio_dev *vdev = to_vio_dev(vhost->dev);
639	struct ibmvfc_crq_queue *crq = &vhost->crq;
640
641	ibmvfc_dbg(vhost, "Releasing CRQ\n");
642	free_irq(vdev->irq, vhost);
643	tasklet_kill(&vhost->tasklet);
644	do {
645		rc = plpar_hcall_norets(H_FREE_CRQ, vdev->unit_address);
646	} while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
647
648	vhost->state = IBMVFC_NO_CRQ;
649	dma_unmap_single(vhost->dev, crq->msg_token, PAGE_SIZE, DMA_BIDIRECTIONAL);
650	free_page((unsigned long)crq->msgs);
651}
652
653/**
654 * ibmvfc_reenable_crq_queue - reenables the CRQ
655 * @vhost:	ibmvfc host struct
656 *
657 * Return value:
658 *	0 on success / other on failure
659 **/
660static int ibmvfc_reenable_crq_queue(struct ibmvfc_host *vhost)
661{
662	int rc;
663	struct vio_dev *vdev = to_vio_dev(vhost->dev);
664
665	/* Re-enable the CRQ */
666	do {
667		rc = plpar_hcall_norets(H_ENABLE_CRQ, vdev->unit_address);
668	} while (rc == H_IN_PROGRESS || rc == H_BUSY || H_IS_LONG_BUSY(rc));
669
670	if (rc)
671		dev_err(vhost->dev, "Error enabling adapter (rc=%d)\n", rc);
672
673	return rc;
674}
675
676/**
677 * ibmvfc_reset_crq - resets a crq after a failure
678 * @vhost:	ibmvfc host struct
679 *
680 * Return value:
681 *	0 on success / other on failure
682 **/
683static int ibmvfc_reset_crq(struct ibmvfc_host *vhost)
684{
685	int rc;
686	struct vio_dev *vdev = to_vio_dev(vhost->dev);
687	struct ibmvfc_crq_queue *crq = &vhost->crq;
688
689	/* Close the CRQ */
690	do {
691		rc = plpar_hcall_norets(H_FREE_CRQ, vdev->unit_address);
692	} while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
693
694	vhost->state = IBMVFC_NO_CRQ;
695	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_NONE);
696
697	/* Clean out the queue */
698	memset(crq->msgs, 0, PAGE_SIZE);
699	crq->cur = 0;
700
701	/* And re-open it again */
702	rc = plpar_hcall_norets(H_REG_CRQ, vdev->unit_address,
703				crq->msg_token, PAGE_SIZE);
704
705	if (rc == H_CLOSED)
706		/* Adapter is good, but other end is not ready */
707		dev_warn(vhost->dev, "Partner adapter not ready\n");
708	else if (rc != 0)
709		dev_warn(vhost->dev, "Couldn't register crq (rc=%d)\n", rc);
710
711	return rc;
712}
713
714/**
715 * ibmvfc_valid_event - Determines if event is valid.
716 * @pool:	event_pool that contains the event
717 * @evt:	ibmvfc event to be checked for validity
718 *
719 * Return value:
720 *	1 if event is valid / 0 if event is not valid
721 **/
722static int ibmvfc_valid_event(struct ibmvfc_event_pool *pool,
723			      struct ibmvfc_event *evt)
724{
725	int index = evt - pool->events;
726	if (index < 0 || index >= pool->size)	/* outside of bounds */
727		return 0;
728	if (evt != pool->events + index)	/* unaligned */
729		return 0;
730	return 1;
731}
732
733/**
734 * ibmvfc_free_event - Free the specified event
735 * @evt:	ibmvfc_event to be freed
736 *
737 **/
738static void ibmvfc_free_event(struct ibmvfc_event *evt)
739{
740	struct ibmvfc_host *vhost = evt->vhost;
741	struct ibmvfc_event_pool *pool = &vhost->pool;
742
743	BUG_ON(!ibmvfc_valid_event(pool, evt));
744	BUG_ON(atomic_inc_return(&evt->free) != 1);
745	list_add_tail(&evt->queue, &vhost->free);
746}
747
748/**
749 * ibmvfc_scsi_eh_done - EH done function for queuecommand commands
750 * @evt:	ibmvfc event struct
751 *
752 * This function does not setup any error status, that must be done
753 * before this function gets called.
754 **/
755static void ibmvfc_scsi_eh_done(struct ibmvfc_event *evt)
756{
757	struct scsi_cmnd *cmnd = evt->cmnd;
758
759	if (cmnd) {
760		scsi_dma_unmap(cmnd);
761		cmnd->scsi_done(cmnd);
762	}
763
764	if (evt->eh_comp)
765		complete(evt->eh_comp);
766
767	ibmvfc_free_event(evt);
768}
769
770/**
771 * ibmvfc_fail_request - Fail request with specified error code
772 * @evt:		ibmvfc event struct
773 * @error_code:	error code to fail request with
774 *
775 * Return value:
776 *	none
777 **/
778static void ibmvfc_fail_request(struct ibmvfc_event *evt, int error_code)
779{
780	if (evt->cmnd) {
781		evt->cmnd->result = (error_code << 16);
782		evt->done = ibmvfc_scsi_eh_done;
783	} else
784		evt->xfer_iu->mad_common.status = IBMVFC_MAD_DRIVER_FAILED;
785
786	list_del(&evt->queue);
787	del_timer(&evt->timer);
788	ibmvfc_trc_end(evt);
789	evt->done(evt);
790}
791
792/**
793 * ibmvfc_purge_requests - Our virtual adapter just shut down. Purge any sent requests
794 * @vhost:		ibmvfc host struct
795 * @error_code:	error code to fail requests with
796 *
797 * Return value:
798 *	none
799 **/
800static void ibmvfc_purge_requests(struct ibmvfc_host *vhost, int error_code)
801{
802	struct ibmvfc_event *evt, *pos;
803
804	ibmvfc_dbg(vhost, "Purging all requests\n");
805	list_for_each_entry_safe(evt, pos, &vhost->sent, queue)
806		ibmvfc_fail_request(evt, error_code);
807}
808
809/**
810 * __ibmvfc_reset_host - Reset the connection to the server (no locking)
811 * @vhost:	struct ibmvfc host to reset
812 **/
813static void __ibmvfc_reset_host(struct ibmvfc_host *vhost)
814{
815	int rc;
816
817	scsi_block_requests(vhost->host);
818	ibmvfc_purge_requests(vhost, DID_ERROR);
819	if ((rc = ibmvfc_reset_crq(vhost)) ||
820	    (rc = ibmvfc_send_crq_init(vhost)) ||
821	    (rc = vio_enable_interrupts(to_vio_dev(vhost->dev)))) {
822		dev_err(vhost->dev, "Error after reset rc=%d\n", rc);
823		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
824	} else
825		ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
826}
827
828/**
829 * ibmvfc_reset_host - Reset the connection to the server
830 * @vhost:	struct ibmvfc host to reset
831 **/
832static void ibmvfc_reset_host(struct ibmvfc_host *vhost)
833{
834	unsigned long flags;
835
836	spin_lock_irqsave(vhost->host->host_lock, flags);
837	__ibmvfc_reset_host(vhost);
838	spin_unlock_irqrestore(vhost->host->host_lock, flags);
839}
840
841/**
842 * ibmvfc_retry_host_init - Retry host initialization if allowed
843 * @vhost:	ibmvfc host struct
844 *
845 **/
846static void ibmvfc_retry_host_init(struct ibmvfc_host *vhost)
847{
848	if (vhost->action == IBMVFC_HOST_ACTION_INIT_WAIT) {
849		vhost->delay_init = 1;
850		if (++vhost->init_retries > IBMVFC_MAX_HOST_INIT_RETRIES) {
851			dev_err(vhost->dev,
852				"Host initialization retries exceeded. Taking adapter offline\n");
853			ibmvfc_link_down(vhost, IBMVFC_HOST_OFFLINE);
854		} else if (vhost->init_retries == IBMVFC_MAX_HOST_INIT_RETRIES)
855			__ibmvfc_reset_host(vhost);
856		else
857			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT);
858	}
859
860	wake_up(&vhost->work_wait_q);
861}
862
863/**
864 * __ibmvfc_get_target - Find the specified scsi_target (no locking)
865 * @starget:	scsi target struct
866 *
867 * Return value:
868 *	ibmvfc_target struct / NULL if not found
869 **/
870static struct ibmvfc_target *__ibmvfc_get_target(struct scsi_target *starget)
871{
872	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
873	struct ibmvfc_host *vhost = shost_priv(shost);
874	struct ibmvfc_target *tgt;
875
876	list_for_each_entry(tgt, &vhost->targets, queue)
877		if (tgt->target_id == starget->id) {
878			kref_get(&tgt->kref);
879			return tgt;
880		}
881	return NULL;
882}
883
884/**
885 * ibmvfc_get_target - Find the specified scsi_target
886 * @starget:	scsi target struct
887 *
888 * Return value:
889 *	ibmvfc_target struct / NULL if not found
890 **/
891static struct ibmvfc_target *ibmvfc_get_target(struct scsi_target *starget)
892{
893	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
894	struct ibmvfc_target *tgt;
895	unsigned long flags;
896
897	spin_lock_irqsave(shost->host_lock, flags);
898	tgt = __ibmvfc_get_target(starget);
899	spin_unlock_irqrestore(shost->host_lock, flags);
900	return tgt;
901}
902
903/**
904 * ibmvfc_get_host_speed - Get host port speed
905 * @shost:		scsi host struct
906 *
907 * Return value:
908 * 	none
909 **/
910static void ibmvfc_get_host_speed(struct Scsi_Host *shost)
911{
912	struct ibmvfc_host *vhost = shost_priv(shost);
913	unsigned long flags;
914
915	spin_lock_irqsave(shost->host_lock, flags);
916	if (vhost->state == IBMVFC_ACTIVE) {
917		switch (vhost->login_buf->resp.link_speed / 100) {
918		case 1:
919			fc_host_speed(shost) = FC_PORTSPEED_1GBIT;
920			break;
921		case 2:
922			fc_host_speed(shost) = FC_PORTSPEED_2GBIT;
923			break;
924		case 4:
925			fc_host_speed(shost) = FC_PORTSPEED_4GBIT;
926			break;
927		case 8:
928			fc_host_speed(shost) = FC_PORTSPEED_8GBIT;
929			break;
930		case 10:
931			fc_host_speed(shost) = FC_PORTSPEED_10GBIT;
932			break;
933		case 16:
934			fc_host_speed(shost) = FC_PORTSPEED_16GBIT;
935			break;
936		default:
937			ibmvfc_log(vhost, 3, "Unknown port speed: %lld Gbit\n",
938				   vhost->login_buf->resp.link_speed / 100);
939			fc_host_speed(shost) = FC_PORTSPEED_UNKNOWN;
940			break;
941		}
942	} else
943		fc_host_speed(shost) = FC_PORTSPEED_UNKNOWN;
944	spin_unlock_irqrestore(shost->host_lock, flags);
945}
946
947/**
948 * ibmvfc_get_host_port_state - Get host port state
949 * @shost:		scsi host struct
950 *
951 * Return value:
952 * 	none
953 **/
954static void ibmvfc_get_host_port_state(struct Scsi_Host *shost)
955{
956	struct ibmvfc_host *vhost = shost_priv(shost);
957	unsigned long flags;
958
959	spin_lock_irqsave(shost->host_lock, flags);
960	switch (vhost->state) {
961	case IBMVFC_INITIALIZING:
962	case IBMVFC_ACTIVE:
963		fc_host_port_state(shost) = FC_PORTSTATE_ONLINE;
964		break;
965	case IBMVFC_LINK_DOWN:
966		fc_host_port_state(shost) = FC_PORTSTATE_LINKDOWN;
967		break;
968	case IBMVFC_LINK_DEAD:
969	case IBMVFC_HOST_OFFLINE:
970		fc_host_port_state(shost) = FC_PORTSTATE_OFFLINE;
971		break;
972	case IBMVFC_HALTED:
973		fc_host_port_state(shost) = FC_PORTSTATE_BLOCKED;
974		break;
975	case IBMVFC_NO_CRQ:
976		fc_host_port_state(shost) = FC_PORTSTATE_UNKNOWN;
977		break;
978	default:
979		ibmvfc_log(vhost, 3, "Unknown port state: %d\n", vhost->state);
980		fc_host_port_state(shost) = FC_PORTSTATE_UNKNOWN;
981		break;
982	}
983	spin_unlock_irqrestore(shost->host_lock, flags);
984}
985
986/**
987 * ibmvfc_set_rport_dev_loss_tmo - Set rport's device loss timeout
988 * @rport:		rport struct
989 * @timeout:	timeout value
990 *
991 * Return value:
992 * 	none
993 **/
994static void ibmvfc_set_rport_dev_loss_tmo(struct fc_rport *rport, u32 timeout)
995{
996	if (timeout)
997		rport->dev_loss_tmo = timeout;
998	else
999		rport->dev_loss_tmo = 1;
1000}
1001
1002/**
1003 * ibmvfc_release_tgt - Free memory allocated for a target
1004 * @kref:		kref struct
1005 *
1006 **/
1007static void ibmvfc_release_tgt(struct kref *kref)
1008{
1009	struct ibmvfc_target *tgt = container_of(kref, struct ibmvfc_target, kref);
1010	kfree(tgt);
1011}
1012
1013/**
1014 * ibmvfc_get_starget_node_name - Get SCSI target's node name
1015 * @starget:	scsi target struct
1016 *
1017 * Return value:
1018 * 	none
1019 **/
1020static void ibmvfc_get_starget_node_name(struct scsi_target *starget)
1021{
1022	struct ibmvfc_target *tgt = ibmvfc_get_target(starget);
1023	fc_starget_port_name(starget) = tgt ? tgt->ids.node_name : 0;
1024	if (tgt)
1025		kref_put(&tgt->kref, ibmvfc_release_tgt);
1026}
1027
1028/**
1029 * ibmvfc_get_starget_port_name - Get SCSI target's port name
1030 * @starget:	scsi target struct
1031 *
1032 * Return value:
1033 * 	none
1034 **/
1035static void ibmvfc_get_starget_port_name(struct scsi_target *starget)
1036{
1037	struct ibmvfc_target *tgt = ibmvfc_get_target(starget);
1038	fc_starget_port_name(starget) = tgt ? tgt->ids.port_name : 0;
1039	if (tgt)
1040		kref_put(&tgt->kref, ibmvfc_release_tgt);
1041}
1042
1043/**
1044 * ibmvfc_get_starget_port_id - Get SCSI target's port ID
1045 * @starget:	scsi target struct
1046 *
1047 * Return value:
1048 * 	none
1049 **/
1050static void ibmvfc_get_starget_port_id(struct scsi_target *starget)
1051{
1052	struct ibmvfc_target *tgt = ibmvfc_get_target(starget);
1053	fc_starget_port_id(starget) = tgt ? tgt->scsi_id : -1;
1054	if (tgt)
1055		kref_put(&tgt->kref, ibmvfc_release_tgt);
1056}
1057
1058/**
1059 * ibmvfc_wait_while_resetting - Wait while the host resets
1060 * @vhost:		ibmvfc host struct
1061 *
1062 * Return value:
1063 * 	0 on success / other on failure
1064 **/
1065static int ibmvfc_wait_while_resetting(struct ibmvfc_host *vhost)
1066{
1067	long timeout = wait_event_timeout(vhost->init_wait_q,
1068					  ((vhost->state == IBMVFC_ACTIVE ||
1069					    vhost->state == IBMVFC_HOST_OFFLINE ||
1070					    vhost->state == IBMVFC_LINK_DEAD) &&
1071					   vhost->action == IBMVFC_HOST_ACTION_NONE),
1072					  (init_timeout * HZ));
1073
1074	return timeout ? 0 : -EIO;
1075}
1076
1077/**
1078 * ibmvfc_issue_fc_host_lip - Re-initiate link initialization
1079 * @shost:		scsi host struct
1080 *
1081 * Return value:
1082 * 	0 on success / other on failure
1083 **/
1084static int ibmvfc_issue_fc_host_lip(struct Scsi_Host *shost)
1085{
1086	struct ibmvfc_host *vhost = shost_priv(shost);
1087
1088	dev_err(vhost->dev, "Initiating host LIP. Resetting connection\n");
1089	ibmvfc_reset_host(vhost);
1090	return ibmvfc_wait_while_resetting(vhost);
1091}
1092
1093/**
1094 * ibmvfc_gather_partition_info - Gather info about the LPAR
1095 *
1096 * Return value:
1097 *	none
1098 **/
1099static void ibmvfc_gather_partition_info(struct ibmvfc_host *vhost)
1100{
1101	struct device_node *rootdn;
1102	const char *name;
1103	const unsigned int *num;
1104
1105	rootdn = of_find_node_by_path("/");
1106	if (!rootdn)
1107		return;
1108
1109	name = of_get_property(rootdn, "ibm,partition-name", NULL);
1110	if (name)
1111		strncpy(vhost->partition_name, name, sizeof(vhost->partition_name));
1112	num = of_get_property(rootdn, "ibm,partition-no", NULL);
1113	if (num)
1114		vhost->partition_number = *num;
1115	of_node_put(rootdn);
1116}
1117
1118/**
1119 * ibmvfc_set_login_info - Setup info for NPIV login
1120 * @vhost:	ibmvfc host struct
1121 *
1122 * Return value:
1123 *	none
1124 **/
1125static void ibmvfc_set_login_info(struct ibmvfc_host *vhost)
1126{
1127	struct ibmvfc_npiv_login *login_info = &vhost->login_info;
1128	struct device_node *of_node = vhost->dev->archdata.of_node;
1129	const char *location;
1130
1131	memset(login_info, 0, sizeof(*login_info));
1132
1133	login_info->ostype = IBMVFC_OS_LINUX;
1134	login_info->max_dma_len = IBMVFC_MAX_SECTORS << 9;
1135	login_info->max_payload = sizeof(struct ibmvfc_fcp_cmd_iu);
1136	login_info->max_response = sizeof(struct ibmvfc_fcp_rsp);
1137	login_info->partition_num = vhost->partition_number;
1138	login_info->vfc_frame_version = 1;
1139	login_info->fcp_version = 3;
1140	if (vhost->client_migrated)
1141		login_info->flags = IBMVFC_CLIENT_MIGRATED;
1142
1143	login_info->max_cmds = max_requests + IBMVFC_NUM_INTERNAL_REQ;
1144	login_info->capabilities = IBMVFC_CAN_MIGRATE;
1145	login_info->async.va = vhost->async_crq.msg_token;
1146	login_info->async.len = vhost->async_crq.size * sizeof(*vhost->async_crq.msgs);
1147	strncpy(login_info->partition_name, vhost->partition_name, IBMVFC_MAX_NAME);
1148	strncpy(login_info->device_name,
1149		dev_name(&vhost->host->shost_gendev), IBMVFC_MAX_NAME);
1150
1151	location = of_get_property(of_node, "ibm,loc-code", NULL);
1152	location = location ? location : dev_name(vhost->dev);
1153	strncpy(login_info->drc_name, location, IBMVFC_MAX_NAME);
1154}
1155
1156/**
1157 * ibmvfc_init_event_pool - Allocates and initializes the event pool for a host
1158 * @vhost:	ibmvfc host who owns the event pool
1159 *
1160 * Returns zero on success.
1161 **/
1162static int ibmvfc_init_event_pool(struct ibmvfc_host *vhost)
1163{
1164	int i;
1165	struct ibmvfc_event_pool *pool = &vhost->pool;
1166
1167	ENTER;
1168	pool->size = max_requests + IBMVFC_NUM_INTERNAL_REQ;
1169	pool->events = kcalloc(pool->size, sizeof(*pool->events), GFP_KERNEL);
1170	if (!pool->events)
1171		return -ENOMEM;
1172
1173	pool->iu_storage = dma_alloc_coherent(vhost->dev,
1174					      pool->size * sizeof(*pool->iu_storage),
1175					      &pool->iu_token, 0);
1176
1177	if (!pool->iu_storage) {
1178		kfree(pool->events);
1179		return -ENOMEM;
1180	}
1181
1182	for (i = 0; i < pool->size; ++i) {
1183		struct ibmvfc_event *evt = &pool->events[i];
1184		atomic_set(&evt->free, 1);
1185		evt->crq.valid = 0x80;
1186		evt->crq.ioba = pool->iu_token + (sizeof(*evt->xfer_iu) * i);
1187		evt->xfer_iu = pool->iu_storage + i;
1188		evt->vhost = vhost;
1189		evt->ext_list = NULL;
1190		list_add_tail(&evt->queue, &vhost->free);
1191	}
1192
1193	LEAVE;
1194	return 0;
1195}
1196
1197/**
1198 * ibmvfc_free_event_pool - Frees memory of the event pool of a host
1199 * @vhost:	ibmvfc host who owns the event pool
1200 *
1201 **/
1202static void ibmvfc_free_event_pool(struct ibmvfc_host *vhost)
1203{
1204	int i;
1205	struct ibmvfc_event_pool *pool = &vhost->pool;
1206
1207	ENTER;
1208	for (i = 0; i < pool->size; ++i) {
1209		list_del(&pool->events[i].queue);
1210		BUG_ON(atomic_read(&pool->events[i].free) != 1);
1211		if (pool->events[i].ext_list)
1212			dma_pool_free(vhost->sg_pool,
1213				      pool->events[i].ext_list,
1214				      pool->events[i].ext_list_token);
1215	}
1216
1217	kfree(pool->events);
1218	dma_free_coherent(vhost->dev,
1219			  pool->size * sizeof(*pool->iu_storage),
1220			  pool->iu_storage, pool->iu_token);
1221	LEAVE;
1222}
1223
1224/**
1225 * ibmvfc_get_event - Gets the next free event in pool
1226 * @vhost:	ibmvfc host struct
1227 *
1228 * Returns a free event from the pool.
1229 **/
1230static struct ibmvfc_event *ibmvfc_get_event(struct ibmvfc_host *vhost)
1231{
1232	struct ibmvfc_event *evt;
1233
1234	BUG_ON(list_empty(&vhost->free));
1235	evt = list_entry(vhost->free.next, struct ibmvfc_event, queue);
1236	atomic_set(&evt->free, 0);
1237	list_del(&evt->queue);
1238	return evt;
1239}
1240
1241/**
1242 * ibmvfc_init_event - Initialize fields in an event struct that are always
1243 *				required.
1244 * @evt:	The event
1245 * @done:	Routine to call when the event is responded to
1246 * @format:	SRP or MAD format
1247 **/
1248static void ibmvfc_init_event(struct ibmvfc_event *evt,
1249			      void (*done) (struct ibmvfc_event *), u8 format)
1250{
1251	evt->cmnd = NULL;
1252	evt->sync_iu = NULL;
1253	evt->crq.format = format;
1254	evt->done = done;
1255	evt->eh_comp = NULL;
1256}
1257
1258/**
1259 * ibmvfc_map_sg_list - Initialize scatterlist
1260 * @scmd:	scsi command struct
1261 * @nseg:	number of scatterlist segments
1262 * @md:	memory descriptor list to initialize
1263 **/
1264static void ibmvfc_map_sg_list(struct scsi_cmnd *scmd, int nseg,
1265			       struct srp_direct_buf *md)
1266{
1267	int i;
1268	struct scatterlist *sg;
1269
1270	scsi_for_each_sg(scmd, sg, nseg, i) {
1271		md[i].va = sg_dma_address(sg);
1272		md[i].len = sg_dma_len(sg);
1273		md[i].key = 0;
1274	}
1275}
1276
1277/**
1278 * ibmvfc_map_sg_data - Maps dma for a scatterlist and initializes decriptor fields
1279 * @scmd:		Scsi_Cmnd with the scatterlist
1280 * @evt:		ibmvfc event struct
1281 * @vfc_cmd:	vfc_cmd that contains the memory descriptor
1282 * @dev:		device for which to map dma memory
1283 *
1284 * Returns:
1285 *	0 on success / non-zero on failure
1286 **/
1287static int ibmvfc_map_sg_data(struct scsi_cmnd *scmd,
1288			      struct ibmvfc_event *evt,
1289			      struct ibmvfc_cmd *vfc_cmd, struct device *dev)
1290{
1291
1292	int sg_mapped;
1293	struct srp_direct_buf *data = &vfc_cmd->ioba;
1294	struct ibmvfc_host *vhost = dev_get_drvdata(dev);
1295
1296	sg_mapped = scsi_dma_map(scmd);
1297	if (!sg_mapped) {
1298		vfc_cmd->flags |= IBMVFC_NO_MEM_DESC;
1299		return 0;
1300	} else if (unlikely(sg_mapped < 0)) {
1301		if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1302			scmd_printk(KERN_ERR, scmd, "Failed to map DMA buffer for command\n");
1303		return sg_mapped;
1304	}
1305
1306	if (scmd->sc_data_direction == DMA_TO_DEVICE) {
1307		vfc_cmd->flags |= IBMVFC_WRITE;
1308		vfc_cmd->iu.add_cdb_len |= IBMVFC_WRDATA;
1309	} else {
1310		vfc_cmd->flags |= IBMVFC_READ;
1311		vfc_cmd->iu.add_cdb_len |= IBMVFC_RDDATA;
1312	}
1313
1314	if (sg_mapped == 1) {
1315		ibmvfc_map_sg_list(scmd, sg_mapped, data);
1316		return 0;
1317	}
1318
1319	vfc_cmd->flags |= IBMVFC_SCATTERLIST;
1320
1321	if (!evt->ext_list) {
1322		evt->ext_list = dma_pool_alloc(vhost->sg_pool, GFP_ATOMIC,
1323					       &evt->ext_list_token);
1324
1325		if (!evt->ext_list) {
1326			scsi_dma_unmap(scmd);
1327			if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1328				scmd_printk(KERN_ERR, scmd, "Can't allocate memory for scatterlist\n");
1329			return -ENOMEM;
1330		}
1331	}
1332
1333	ibmvfc_map_sg_list(scmd, sg_mapped, evt->ext_list);
1334
1335	data->va = evt->ext_list_token;
1336	data->len = sg_mapped * sizeof(struct srp_direct_buf);
1337	data->key = 0;
1338	return 0;
1339}
1340
1341/**
1342 * ibmvfc_timeout - Internal command timeout handler
1343 * @evt:	struct ibmvfc_event that timed out
1344 *
1345 * Called when an internally generated command times out
1346 **/
1347static void ibmvfc_timeout(struct ibmvfc_event *evt)
1348{
1349	struct ibmvfc_host *vhost = evt->vhost;
1350	dev_err(vhost->dev, "Command timed out (%p). Resetting connection\n", evt);
1351	ibmvfc_reset_host(vhost);
1352}
1353
1354/**
1355 * ibmvfc_send_event - Transforms event to u64 array and calls send_crq()
1356 * @evt:		event to be sent
1357 * @vhost:		ibmvfc host struct
1358 * @timeout:	timeout in seconds - 0 means do not time command
1359 *
1360 * Returns the value returned from ibmvfc_send_crq(). (Zero for success)
1361 **/
1362static int ibmvfc_send_event(struct ibmvfc_event *evt,
1363			     struct ibmvfc_host *vhost, unsigned long timeout)
1364{
1365	u64 *crq_as_u64 = (u64 *) &evt->crq;
1366	int rc;
1367
1368	/* Copy the IU into the transfer area */
1369	*evt->xfer_iu = evt->iu;
1370	if (evt->crq.format == IBMVFC_CMD_FORMAT)
1371		evt->xfer_iu->cmd.tag = (u64)evt;
1372	else if (evt->crq.format == IBMVFC_MAD_FORMAT)
1373		evt->xfer_iu->mad_common.tag = (u64)evt;
1374	else
1375		BUG();
1376
1377	list_add_tail(&evt->queue, &vhost->sent);
1378	init_timer(&evt->timer);
1379
1380	if (timeout) {
1381		evt->timer.data = (unsigned long) evt;
1382		evt->timer.expires = jiffies + (timeout * HZ);
1383		evt->timer.function = (void (*)(unsigned long))ibmvfc_timeout;
1384		add_timer(&evt->timer);
1385	}
1386
1387	mb();
1388
1389	if ((rc = ibmvfc_send_crq(vhost, crq_as_u64[0], crq_as_u64[1]))) {
1390		list_del(&evt->queue);
1391		del_timer(&evt->timer);
1392
1393		/* If send_crq returns H_CLOSED, return SCSI_MLQUEUE_HOST_BUSY.
1394		 * Firmware will send a CRQ with a transport event (0xFF) to
1395		 * tell this client what has happened to the transport. This
1396		 * will be handled in ibmvfc_handle_crq()
1397		 */
1398		if (rc == H_CLOSED) {
1399			if (printk_ratelimit())
1400				dev_warn(vhost->dev, "Send warning. Receive queue closed, will retry.\n");
1401			if (evt->cmnd)
1402				scsi_dma_unmap(evt->cmnd);
1403			ibmvfc_free_event(evt);
1404			return SCSI_MLQUEUE_HOST_BUSY;
1405		}
1406
1407		dev_err(vhost->dev, "Send error (rc=%d)\n", rc);
1408		if (evt->cmnd) {
1409			evt->cmnd->result = DID_ERROR << 16;
1410			evt->done = ibmvfc_scsi_eh_done;
1411		} else
1412			evt->xfer_iu->mad_common.status = IBMVFC_MAD_CRQ_ERROR;
1413
1414		evt->done(evt);
1415	} else
1416		ibmvfc_trc_start(evt);
1417
1418	return 0;
1419}
1420
1421/**
1422 * ibmvfc_log_error - Log an error for the failed command if appropriate
1423 * @evt:	ibmvfc event to log
1424 *
1425 **/
1426static void ibmvfc_log_error(struct ibmvfc_event *evt)
1427{
1428	struct ibmvfc_cmd *vfc_cmd = &evt->xfer_iu->cmd;
1429	struct ibmvfc_host *vhost = evt->vhost;
1430	struct ibmvfc_fcp_rsp *rsp = &vfc_cmd->rsp;
1431	struct scsi_cmnd *cmnd = evt->cmnd;
1432	const char *err = unknown_error;
1433	int index = ibmvfc_get_err_index(vfc_cmd->status, vfc_cmd->error);
1434	int logerr = 0;
1435	int rsp_code = 0;
1436
1437	if (index >= 0) {
1438		logerr = cmd_status[index].log;
1439		err = cmd_status[index].name;
1440	}
1441
1442	if (!logerr && (vhost->log_level <= (IBMVFC_DEFAULT_LOG_LEVEL + 1)))
1443		return;
1444
1445	if (rsp->flags & FCP_RSP_LEN_VALID)
1446		rsp_code = rsp->data.info.rsp_code;
1447
1448	scmd_printk(KERN_ERR, cmnd, "Command (%02X) failed: %s (%x:%x) "
1449		    "flags: %x fcp_rsp: %x, resid=%d, scsi_status: %x\n",
1450		    cmnd->cmnd[0], err, vfc_cmd->status, vfc_cmd->error,
1451		    rsp->flags, rsp_code, scsi_get_resid(cmnd), rsp->scsi_status);
1452}
1453
1454/**
1455 * ibmvfc_scsi_done - Handle responses from commands
1456 * @evt:	ibmvfc event to be handled
1457 *
1458 * Used as a callback when sending scsi cmds.
1459 **/
1460static void ibmvfc_scsi_done(struct ibmvfc_event *evt)
1461{
1462	struct ibmvfc_cmd *vfc_cmd = &evt->xfer_iu->cmd;
1463	struct ibmvfc_fcp_rsp *rsp = &vfc_cmd->rsp;
1464	struct scsi_cmnd *cmnd = evt->cmnd;
1465	u32 rsp_len = 0;
1466	u32 sense_len = rsp->fcp_sense_len;
1467
1468	if (cmnd) {
1469		if (vfc_cmd->response_flags & IBMVFC_ADAPTER_RESID_VALID)
1470			scsi_set_resid(cmnd, vfc_cmd->adapter_resid);
1471		else if (rsp->flags & FCP_RESID_UNDER)
1472			scsi_set_resid(cmnd, rsp->fcp_resid);
1473		else
1474			scsi_set_resid(cmnd, 0);
1475
1476		if (vfc_cmd->status) {
1477			cmnd->result = ibmvfc_get_err_result(vfc_cmd);
1478
1479			if (rsp->flags & FCP_RSP_LEN_VALID)
1480				rsp_len = rsp->fcp_rsp_len;
1481			if ((sense_len + rsp_len) > SCSI_SENSE_BUFFERSIZE)
1482				sense_len = SCSI_SENSE_BUFFERSIZE - rsp_len;
1483			if ((rsp->flags & FCP_SNS_LEN_VALID) && rsp->fcp_sense_len && rsp_len <= 8)
1484				memcpy(cmnd->sense_buffer, rsp->data.sense + rsp_len, sense_len);
1485			if ((vfc_cmd->status & IBMVFC_VIOS_FAILURE) && (vfc_cmd->error == IBMVFC_PLOGI_REQUIRED))
1486				ibmvfc_reinit_host(evt->vhost);
1487
1488			if (!cmnd->result && (!scsi_get_resid(cmnd) || (rsp->flags & FCP_RESID_OVER)))
1489				cmnd->result = (DID_ERROR << 16);
1490
1491			ibmvfc_log_error(evt);
1492		}
1493
1494		if (!cmnd->result &&
1495		    (scsi_bufflen(cmnd) - scsi_get_resid(cmnd) < cmnd->underflow))
1496			cmnd->result = (DID_ERROR << 16);
1497
1498		scsi_dma_unmap(cmnd);
1499		cmnd->scsi_done(cmnd);
1500	}
1501
1502	if (evt->eh_comp)
1503		complete(evt->eh_comp);
1504
1505	ibmvfc_free_event(evt);
1506}
1507
1508/**
1509 * ibmvfc_host_chkready - Check if the host can accept commands
1510 * @vhost:	 struct ibmvfc host
1511 *
1512 * Returns:
1513 *	1 if host can accept command / 0 if not
1514 **/
1515static inline int ibmvfc_host_chkready(struct ibmvfc_host *vhost)
1516{
1517	int result = 0;
1518
1519	switch (vhost->state) {
1520	case IBMVFC_LINK_DEAD:
1521	case IBMVFC_HOST_OFFLINE:
1522		result = DID_NO_CONNECT << 16;
1523		break;
1524	case IBMVFC_NO_CRQ:
1525	case IBMVFC_INITIALIZING:
1526	case IBMVFC_HALTED:
1527	case IBMVFC_LINK_DOWN:
1528		result = DID_REQUEUE << 16;
1529		break;
1530	case IBMVFC_ACTIVE:
1531		result = 0;
1532		break;
1533	};
1534
1535	return result;
1536}
1537
1538/**
1539 * ibmvfc_queuecommand - The queuecommand function of the scsi template
1540 * @cmnd:	struct scsi_cmnd to be executed
1541 * @done:	Callback function to be called when cmnd is completed
1542 *
1543 * Returns:
1544 *	0 on success / other on failure
1545 **/
1546static int ibmvfc_queuecommand(struct scsi_cmnd *cmnd,
1547			       void (*done) (struct scsi_cmnd *))
1548{
1549	struct ibmvfc_host *vhost = shost_priv(cmnd->device->host);
1550	struct fc_rport *rport = starget_to_rport(scsi_target(cmnd->device));
1551	struct ibmvfc_cmd *vfc_cmd;
1552	struct ibmvfc_event *evt;
1553	u8 tag[2];
1554	int rc;
1555
1556	if (unlikely((rc = fc_remote_port_chkready(rport))) ||
1557	    unlikely((rc = ibmvfc_host_chkready(vhost)))) {
1558		cmnd->result = rc;
1559		done(cmnd);
1560		return 0;
1561	}
1562
1563	cmnd->result = (DID_OK << 16);
1564	evt = ibmvfc_get_event(vhost);
1565	ibmvfc_init_event(evt, ibmvfc_scsi_done, IBMVFC_CMD_FORMAT);
1566	evt->cmnd = cmnd;
1567	cmnd->scsi_done = done;
1568	vfc_cmd = &evt->iu.cmd;
1569	memset(vfc_cmd, 0, sizeof(*vfc_cmd));
1570	vfc_cmd->resp.va = (u64)evt->crq.ioba + offsetof(struct ibmvfc_cmd, rsp);
1571	vfc_cmd->resp.len = sizeof(vfc_cmd->rsp);
1572	vfc_cmd->frame_type = IBMVFC_SCSI_FCP_TYPE;
1573	vfc_cmd->payload_len = sizeof(vfc_cmd->iu);
1574	vfc_cmd->resp_len = sizeof(vfc_cmd->rsp);
1575	vfc_cmd->cancel_key = (unsigned long)cmnd->device->hostdata;
1576	vfc_cmd->tgt_scsi_id = rport->port_id;
1577	vfc_cmd->iu.xfer_len = scsi_bufflen(cmnd);
1578	int_to_scsilun(cmnd->device->lun, &vfc_cmd->iu.lun);
1579	memcpy(vfc_cmd->iu.cdb, cmnd->cmnd, cmnd->cmd_len);
1580
1581	if (scsi_populate_tag_msg(cmnd, tag)) {
1582		vfc_cmd->task_tag = tag[1];
1583		switch (tag[0]) {
1584		case MSG_SIMPLE_TAG:
1585			vfc_cmd->iu.pri_task_attr = IBMVFC_SIMPLE_TASK;
1586			break;
1587		case MSG_HEAD_TAG:
1588			vfc_cmd->iu.pri_task_attr = IBMVFC_HEAD_OF_QUEUE;
1589			break;
1590		case MSG_ORDERED_TAG:
1591			vfc_cmd->iu.pri_task_attr = IBMVFC_ORDERED_TASK;
1592			break;
1593		};
1594	}
1595
1596	if (likely(!(rc = ibmvfc_map_sg_data(cmnd, evt, vfc_cmd, vhost->dev))))
1597		return ibmvfc_send_event(evt, vhost, 0);
1598
1599	ibmvfc_free_event(evt);
1600	if (rc == -ENOMEM)
1601		return SCSI_MLQUEUE_HOST_BUSY;
1602
1603	if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1604		scmd_printk(KERN_ERR, cmnd,
1605			    "Failed to map DMA buffer for command. rc=%d\n", rc);
1606
1607	cmnd->result = DID_ERROR << 16;
1608	done(cmnd);
1609	return 0;
1610}
1611
1612/**
1613 * ibmvfc_sync_completion - Signal that a synchronous command has completed
1614 * @evt:	ibmvfc event struct
1615 *
1616 **/
1617static void ibmvfc_sync_completion(struct ibmvfc_event *evt)
1618{
1619	/* copy the response back */
1620	if (evt->sync_iu)
1621		*evt->sync_iu = *evt->xfer_iu;
1622
1623	complete(&evt->comp);
1624}
1625
1626/**
1627 * ibmvfc_reset_device - Reset the device with the specified reset type
1628 * @sdev:	scsi device to reset
1629 * @type:	reset type
1630 * @desc:	reset type description for log messages
1631 *
1632 * Returns:
1633 *	0 on success / other on failure
1634 **/
1635static int ibmvfc_reset_device(struct scsi_device *sdev, int type, char *desc)
1636{
1637	struct ibmvfc_host *vhost = shost_priv(sdev->host);
1638	struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
1639	struct ibmvfc_cmd *tmf;
1640	struct ibmvfc_event *evt = NULL;
1641	union ibmvfc_iu rsp_iu;
1642	struct ibmvfc_fcp_rsp *fc_rsp = &rsp_iu.cmd.rsp;
1643	int rsp_rc = -EBUSY;
1644	unsigned long flags;
1645	int rsp_code = 0;
1646
1647	spin_lock_irqsave(vhost->host->host_lock, flags);
1648	if (vhost->state == IBMVFC_ACTIVE) {
1649		evt = ibmvfc_get_event(vhost);
1650		ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_CMD_FORMAT);
1651
1652		tmf = &evt->iu.cmd;
1653		memset(tmf, 0, sizeof(*tmf));
1654		tmf->resp.va = (u64)evt->crq.ioba + offsetof(struct ibmvfc_cmd, rsp);
1655		tmf->resp.len = sizeof(tmf->rsp);
1656		tmf->frame_type = IBMVFC_SCSI_FCP_TYPE;
1657		tmf->payload_len = sizeof(tmf->iu);
1658		tmf->resp_len = sizeof(tmf->rsp);
1659		tmf->cancel_key = (unsigned long)sdev->hostdata;
1660		tmf->tgt_scsi_id = rport->port_id;
1661		int_to_scsilun(sdev->lun, &tmf->iu.lun);
1662		tmf->flags = (IBMVFC_NO_MEM_DESC | IBMVFC_TMF);
1663		tmf->iu.tmf_flags = type;
1664		evt->sync_iu = &rsp_iu;
1665
1666		init_completion(&evt->comp);
1667		rsp_rc = ibmvfc_send_event(evt, vhost, default_timeout);
1668	}
1669	spin_unlock_irqrestore(vhost->host->host_lock, flags);
1670
1671	if (rsp_rc != 0) {
1672		sdev_printk(KERN_ERR, sdev, "Failed to send %s reset event. rc=%d\n",
1673			    desc, rsp_rc);
1674		return -EIO;
1675	}
1676
1677	sdev_printk(KERN_INFO, sdev, "Resetting %s\n", desc);
1678	wait_for_completion(&evt->comp);
1679
1680	if (rsp_iu.cmd.status) {
1681		if (fc_rsp->flags & FCP_RSP_LEN_VALID)
1682			rsp_code = fc_rsp->data.info.rsp_code;
1683
1684		sdev_printk(KERN_ERR, sdev, "%s reset failed: %s (%x:%x) "
1685			    "flags: %x fcp_rsp: %x, scsi_status: %x\n",
1686			    desc, ibmvfc_get_cmd_error(rsp_iu.cmd.status, rsp_iu.cmd.error),
1687			    rsp_iu.cmd.status, rsp_iu.cmd.error, fc_rsp->flags, rsp_code,
1688			    fc_rsp->scsi_status);
1689		rsp_rc = -EIO;
1690	} else
1691		sdev_printk(KERN_INFO, sdev, "%s reset successful\n", desc);
1692
1693	spin_lock_irqsave(vhost->host->host_lock, flags);
1694	ibmvfc_free_event(evt);
1695	spin_unlock_irqrestore(vhost->host->host_lock, flags);
1696	return rsp_rc;
1697}
1698
1699/**
1700 * ibmvfc_abort_task_set - Abort outstanding commands to the device
1701 * @sdev:	scsi device to abort commands
1702 *
1703 * This sends an Abort Task Set to the VIOS for the specified device. This does
1704 * NOT send any cancel to the VIOS. That must be done separately.
1705 *
1706 * Returns:
1707 *	0 on success / other on failure
1708 **/
1709static int ibmvfc_abort_task_set(struct scsi_device *sdev)
1710{
1711	struct ibmvfc_host *vhost = shost_priv(sdev->host);
1712	struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
1713	struct ibmvfc_cmd *tmf;
1714	struct ibmvfc_event *evt, *found_evt;
1715	union ibmvfc_iu rsp_iu;
1716	struct ibmvfc_fcp_rsp *fc_rsp = &rsp_iu.cmd.rsp;
1717	int rsp_rc = -EBUSY;
1718	unsigned long flags;
1719	int rsp_code = 0;
1720
1721	spin_lock_irqsave(vhost->host->host_lock, flags);
1722	found_evt = NULL;
1723	list_for_each_entry(evt, &vhost->sent, queue) {
1724		if (evt->cmnd && evt->cmnd->device == sdev) {
1725			found_evt = evt;
1726			break;
1727		}
1728	}
1729
1730	if (!found_evt) {
1731		if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1732			sdev_printk(KERN_INFO, sdev, "No events found to abort\n");
1733		spin_unlock_irqrestore(vhost->host->host_lock, flags);
1734		return 0;
1735	}
1736
1737	if (vhost->state == IBMVFC_ACTIVE) {
1738		evt = ibmvfc_get_event(vhost);
1739		ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_CMD_FORMAT);
1740
1741		tmf = &evt->iu.cmd;
1742		memset(tmf, 0, sizeof(*tmf));
1743		tmf->resp.va = (u64)evt->crq.ioba + offsetof(struct ibmvfc_cmd, rsp);
1744		tmf->resp.len = sizeof(tmf->rsp);
1745		tmf->frame_type = IBMVFC_SCSI_FCP_TYPE;
1746		tmf->payload_len = sizeof(tmf->iu);
1747		tmf->resp_len = sizeof(tmf->rsp);
1748		tmf->cancel_key = (unsigned long)sdev->hostdata;
1749		tmf->tgt_scsi_id = rport->port_id;
1750		int_to_scsilun(sdev->lun, &tmf->iu.lun);
1751		tmf->flags = (IBMVFC_NO_MEM_DESC | IBMVFC_TMF);
1752		tmf->iu.tmf_flags = IBMVFC_ABORT_TASK_SET;
1753		evt->sync_iu = &rsp_iu;
1754
1755		init_completion(&evt->comp);
1756		rsp_rc = ibmvfc_send_event(evt, vhost, default_timeout);
1757	}
1758
1759	spin_unlock_irqrestore(vhost->host->host_lock, flags);
1760
1761	if (rsp_rc != 0) {
1762		sdev_printk(KERN_ERR, sdev, "Failed to send abort. rc=%d\n", rsp_rc);
1763		return -EIO;
1764	}
1765
1766	sdev_printk(KERN_INFO, sdev, "Aborting outstanding commands\n");
1767	wait_for_completion(&evt->comp);
1768
1769	if (rsp_iu.cmd.status) {
1770		if (fc_rsp->flags & FCP_RSP_LEN_VALID)
1771			rsp_code = fc_rsp->data.info.rsp_code;
1772
1773		sdev_printk(KERN_ERR, sdev, "Abort failed: %s (%x:%x) "
1774			    "flags: %x fcp_rsp: %x, scsi_status: %x\n",
1775			    ibmvfc_get_cmd_error(rsp_iu.cmd.status, rsp_iu.cmd.error),
1776			    rsp_iu.cmd.status, rsp_iu.cmd.error, fc_rsp->flags, rsp_code,
1777			    fc_rsp->scsi_status);
1778		rsp_rc = -EIO;
1779	} else
1780		sdev_printk(KERN_INFO, sdev, "Abort successful\n");
1781
1782	spin_lock_irqsave(vhost->host->host_lock, flags);
1783	ibmvfc_free_event(evt);
1784	spin_unlock_irqrestore(vhost->host->host_lock, flags);
1785	return rsp_rc;
1786}
1787
1788/**
1789 * ibmvfc_cancel_all - Cancel all outstanding commands to the device
1790 * @sdev:	scsi device to cancel commands
1791 * @type:	type of error recovery being performed
1792 *
1793 * This sends a cancel to the VIOS for the specified device. This does
1794 * NOT send any abort to the actual device. That must be done separately.
1795 *
1796 * Returns:
1797 *	0 on success / other on failure
1798 **/
1799static int ibmvfc_cancel_all(struct scsi_device *sdev, int type)
1800{
1801	struct ibmvfc_host *vhost = shost_priv(sdev->host);
1802	struct scsi_target *starget = scsi_target(sdev);
1803	struct fc_rport *rport = starget_to_rport(starget);
1804	struct ibmvfc_tmf *tmf;
1805	struct ibmvfc_event *evt, *found_evt;
1806	union ibmvfc_iu rsp;
1807	int rsp_rc = -EBUSY;
1808	unsigned long flags;
1809	u16 status;
1810
1811	ENTER;
1812	spin_lock_irqsave(vhost->host->host_lock, flags);
1813	found_evt = NULL;
1814	list_for_each_entry(evt, &vhost->sent, queue) {
1815		if (evt->cmnd && evt->cmnd->device == sdev) {
1816			found_evt = evt;
1817			break;
1818		}
1819	}
1820
1821	if (!found_evt) {
1822		if (vhost->log_level > IBMVFC_DEFAULT_LOG_LEVEL)
1823			sdev_printk(KERN_INFO, sdev, "No events found to cancel\n");
1824		spin_unlock_irqrestore(vhost->host->host_lock, flags);
1825		return 0;
1826	}
1827
1828	if (vhost->state == IBMVFC_ACTIVE) {
1829		evt = ibmvfc_get_event(vhost);
1830		ibmvfc_init_event(evt, ibmvfc_sync_completion, IBMVFC_MAD_FORMAT);
1831
1832		tmf = &evt->iu.tmf;
1833		memset(tmf, 0, sizeof(*tmf));
1834		tmf->common.version = 1;
1835		tmf->common.opcode = IBMVFC_TMF_MAD;
1836		tmf->common.length = sizeof(*tmf);
1837		tmf->scsi_id = rport->port_id;
1838		int_to_scsilun(sdev->lun, &tmf->lun);
1839		tmf->flags = (type | IBMVFC_TMF_LUA_VALID);
1840		tmf->cancel_key = (unsigned long)sdev->hostdata;
1841		tmf->my_cancel_key = (unsigned long)starget->hostdata;
1842
1843		evt->sync_iu = &rsp;
1844		init_completion(&evt->comp);
1845		rsp_rc = ibmvfc_send_event(evt, vhost, default_timeout);
1846	}
1847
1848	spin_unlock_irqrestore(vhost->host->host_lock, flags);
1849
1850	if (rsp_rc != 0) {
1851		sdev_printk(KERN_ERR, sdev, "Failed to send cancel event. rc=%d\n", rsp_rc);
1852		return -EIO;
1853	}
1854
1855	sdev_printk(KERN_INFO, sdev, "Cancelling outstanding commands.\n");
1856
1857	wait_for_completion(&evt->comp);
1858	status = rsp.mad_common.status;
1859	spin_lock_irqsave(vhost->host->host_lock, flags);
1860	ibmvfc_free_event(evt);
1861	spin_unlock_irqrestore(vhost->host->host_lock, flags);
1862
1863	if (status != IBMVFC_MAD_SUCCESS) {
1864		sdev_printk(KERN_WARNING, sdev, "Cancel failed with rc=%x\n", status);
1865		return -EIO;
1866	}
1867
1868	sdev_printk(KERN_INFO, sdev, "Successfully cancelled outstanding commands\n");
1869	return 0;
1870}
1871
1872/**
1873 * ibmvfc_match_target - Match function for specified target
1874 * @evt:	ibmvfc event struct
1875 * @device:	device to match (starget)
1876 *
1877 * Returns:
1878 *	1 if event matches starget / 0 if event does not match starget
1879 **/
1880static int ibmvfc_match_target(struct ibmvfc_event *evt, void *device)
1881{
1882	if (evt->cmnd && scsi_target(evt->cmnd->device) == device)
1883		return 1;
1884	return 0;
1885}
1886
1887/**
1888 * ibmvfc_match_lun - Match function for specified LUN
1889 * @evt:	ibmvfc event struct
1890 * @device:	device to match (sdev)
1891 *
1892 * Returns:
1893 *	1 if event matches sdev / 0 if event does not match sdev
1894 **/
1895static int ibmvfc_match_lun(struct ibmvfc_event *evt, void *device)
1896{
1897	if (evt->cmnd && evt->cmnd->device == device)
1898		return 1;
1899	return 0;
1900}
1901
1902/**
1903 * ibmvfc_wait_for_ops - Wait for ops to complete
1904 * @vhost:	ibmvfc host struct
1905 * @device:	device to match (starget or sdev)
1906 * @match:	match function
1907 *
1908 * Returns:
1909 *	SUCCESS / FAILED
1910 **/
1911static int ibmvfc_wait_for_ops(struct ibmvfc_host *vhost, void *device,
1912			       int (*match) (struct ibmvfc_event *, void *))
1913{
1914	struct ibmvfc_event *evt;
1915	DECLARE_COMPLETION_ONSTACK(comp);
1916	int wait;
1917	unsigned long flags;
1918	signed long timeout = init_timeout * HZ;
1919
1920	ENTER;
1921	do {
1922		wait = 0;
1923		spin_lock_irqsave(vhost->host->host_lock, flags);
1924		list_for_each_entry(evt, &vhost->sent, queue) {
1925			if (match(evt, device)) {
1926				evt->eh_comp = &comp;
1927				wait++;
1928			}
1929		}
1930		spin_unlock_irqrestore(vhost->host->host_lock, flags);
1931
1932		if (wait) {
1933			timeout = wait_for_completion_timeout(&comp, timeout);
1934
1935			if (!timeout) {
1936				wait = 0;
1937				spin_lock_irqsave(vhost->host->host_lock, flags);
1938				list_for_each_entry(evt, &vhost->sent, queue) {
1939					if (match(evt, device)) {
1940						evt->eh_comp = NULL;
1941						wait++;
1942					}
1943				}
1944				spin_unlock_irqrestore(vhost->host->host_lock, flags);
1945				if (wait)
1946					dev_err(vhost->dev, "Timed out waiting for aborted commands\n");
1947				LEAVE;
1948				return wait ? FAILED : SUCCESS;
1949			}
1950		}
1951	} while (wait);
1952
1953	LEAVE;
1954	return SUCCESS;
1955}
1956
1957/**
1958 * ibmvfc_eh_abort_handler - Abort a command
1959 * @cmd:	scsi command to abort
1960 *
1961 * Returns:
1962 *	SUCCESS / FAILED
1963 **/
1964static int ibmvfc_eh_abort_handler(struct scsi_cmnd *cmd)
1965{
1966	struct scsi_device *sdev = cmd->device;
1967	struct ibmvfc_host *vhost = shost_priv(sdev->host);
1968	int cancel_rc, abort_rc;
1969	int rc = FAILED;
1970
1971	ENTER;
1972	ibmvfc_wait_while_resetting(vhost);
1973	cancel_rc = ibmvfc_cancel_all(sdev, IBMVFC_TMF_ABORT_TASK_SET);
1974	abort_rc = ibmvfc_abort_task_set(sdev);
1975
1976	if (!cancel_rc && !abort_rc)
1977		rc = ibmvfc_wait_for_ops(vhost, sdev, ibmvfc_match_lun);
1978
1979	LEAVE;
1980	return rc;
1981}
1982
1983/**
1984 * ibmvfc_eh_device_reset_handler - Reset a single LUN
1985 * @cmd:	scsi command struct
1986 *
1987 * Returns:
1988 *	SUCCESS / FAILED
1989 **/
1990static int ibmvfc_eh_device_reset_handler(struct scsi_cmnd *cmd)
1991{
1992	struct scsi_device *sdev = cmd->device;
1993	struct ibmvfc_host *vhost = shost_priv(sdev->host);
1994	int cancel_rc, reset_rc;
1995	int rc = FAILED;
1996
1997	ENTER;
1998	ibmvfc_wait_while_resetting(vhost);
1999	cancel_rc = ibmvfc_cancel_all(sdev, IBMVFC_TMF_LUN_RESET);
2000	reset_rc = ibmvfc_reset_device(sdev, IBMVFC_LUN_RESET, "LUN");
2001
2002	if (!cancel_rc && !reset_rc)
2003		rc = ibmvfc_wait_for_ops(vhost, sdev, ibmvfc_match_lun);
2004
2005	LEAVE;
2006	return rc;
2007}
2008
2009/**
2010 * ibmvfc_dev_cancel_all - Device iterated cancel all function
2011 * @sdev:	scsi device struct
2012 * @data:	return code
2013 *
2014 **/
2015static void ibmvfc_dev_cancel_all(struct scsi_device *sdev, void *data)
2016{
2017	unsigned long *rc = data;
2018	*rc |= ibmvfc_cancel_all(sdev, IBMVFC_TMF_TGT_RESET);
2019}
2020
2021/**
2022 * ibmvfc_dev_abort_all - Device iterated abort task set function
2023 * @sdev:	scsi device struct
2024 * @data:	return code
2025 *
2026 **/
2027static void ibmvfc_dev_abort_all(struct scsi_device *sdev, void *data)
2028{
2029	unsigned long *rc = data;
2030	*rc |= ibmvfc_abort_task_set(sdev);
2031}
2032
2033/**
2034 * ibmvfc_eh_target_reset_handler - Reset the target
2035 * @cmd:	scsi command struct
2036 *
2037 * Returns:
2038 *	SUCCESS / FAILED
2039 **/
2040static int ibmvfc_eh_target_reset_handler(struct scsi_cmnd *cmd)
2041{
2042	struct scsi_device *sdev = cmd->device;
2043	struct ibmvfc_host *vhost = shost_priv(sdev->host);
2044	struct scsi_target *starget = scsi_target(sdev);
2045	int reset_rc;
2046	int rc = FAILED;
2047	unsigned long cancel_rc = 0;
2048
2049	ENTER;
2050	ibmvfc_wait_while_resetting(vhost);
2051	starget_for_each_device(starget, &cancel_rc, ibmvfc_dev_cancel_all);
2052	reset_rc = ibmvfc_reset_device(sdev, IBMVFC_TARGET_RESET, "target");
2053
2054	if (!cancel_rc && !reset_rc)
2055		rc = ibmvfc_wait_for_ops(vhost, starget, ibmvfc_match_target);
2056
2057	LEAVE;
2058	return rc;
2059}
2060
2061/**
2062 * ibmvfc_eh_host_reset_handler - Reset the connection to the server
2063 * @cmd:	struct scsi_cmnd having problems
2064 *
2065 **/
2066static int ibmvfc_eh_host_reset_handler(struct scsi_cmnd *cmd)
2067{
2068	int rc;
2069	struct ibmvfc_host *vhost = shost_priv(cmd->device->host);
2070
2071	dev_err(vhost->dev, "Resetting connection due to error recovery\n");
2072	rc = ibmvfc_issue_fc_host_lip(vhost->host);
2073	return rc ? FAILED : SUCCESS;
2074}
2075
2076/**
2077 * ibmvfc_terminate_rport_io - Terminate all pending I/O to the rport.
2078 * @rport:		rport struct
2079 *
2080 * Return value:
2081 * 	none
2082 **/
2083static void ibmvfc_terminate_rport_io(struct fc_rport *rport)
2084{
2085	struct scsi_target *starget = to_scsi_target(&rport->dev);
2086	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
2087	struct ibmvfc_host *vhost = shost_priv(shost);
2088	unsigned long cancel_rc = 0;
2089	unsigned long abort_rc = 0;
2090	int rc = FAILED;
2091
2092	ENTER;
2093	starget_for_each_device(starget, &cancel_rc, ibmvfc_dev_cancel_all);
2094	starget_for_each_device(starget, &abort_rc, ibmvfc_dev_abort_all);
2095
2096	if (!cancel_rc && !abort_rc)
2097		rc = ibmvfc_wait_for_ops(vhost, starget, ibmvfc_match_target);
2098
2099	if (rc == FAILED)
2100		ibmvfc_issue_fc_host_lip(shost);
2101	LEAVE;
2102}
2103
2104static const struct {
2105	enum ibmvfc_async_event ae;
2106	const char *desc;
2107} ae_desc [] = {
2108	{ IBMVFC_AE_ELS_PLOGI,		"PLOGI" },
2109	{ IBMVFC_AE_ELS_LOGO,		"LOGO" },
2110	{ IBMVFC_AE_ELS_PRLO,		"PRLO" },
2111	{ IBMVFC_AE_SCN_NPORT,		"N-Port SCN" },
2112	{ IBMVFC_AE_SCN_GROUP,		"Group SCN" },
2113	{ IBMVFC_AE_SCN_DOMAIN,		"Domain SCN" },
2114	{ IBMVFC_AE_SCN_FABRIC,		"Fabric SCN" },
2115	{ IBMVFC_AE_LINK_UP,		"Link Up" },
2116	{ IBMVFC_AE_LINK_DOWN,		"Link Down" },
2117	{ IBMVFC_AE_LINK_DEAD,		"Link Dead" },
2118	{ IBMVFC_AE_HALT,			"Halt" },
2119	{ IBMVFC_AE_RESUME,		"Resume" },
2120	{ IBMVFC_AE_ADAPTER_FAILED,	"Adapter Failed" },
2121};
2122
2123static const char *unknown_ae = "Unknown async";
2124
2125/**
2126 * ibmvfc_get_ae_desc - Get text description for async event
2127 * @ae:	async event
2128 *
2129 **/
2130static const char *ibmvfc_get_ae_desc(u64 ae)
2131{
2132	int i;
2133
2134	for (i = 0; i < ARRAY_SIZE(ae_desc); i++)
2135		if (ae_desc[i].ae == ae)
2136			return ae_desc[i].desc;
2137
2138	return unknown_ae;
2139}
2140
2141/**
2142 * ibmvfc_handle_async - Handle an async event from the adapter
2143 * @crq:	crq to process
2144 * @vhost:	ibmvfc host struct
2145 *
2146 **/
2147static void ibmvfc_handle_async(struct ibmvfc_async_crq *crq,
2148				struct ibmvfc_host *vhost)
2149{
2150	const char *desc = ibmvfc_get_ae_desc(crq->event);
2151
2152	ibmvfc_log(vhost, 3, "%s event received. scsi_id: %llx, wwpn: %llx,"
2153		   " node_name: %llx\n", desc, crq->scsi_id, crq->wwpn, crq->node_name);
2154
2155	switch (crq->event) {
2156	case IBMVFC_AE_LINK_UP:
2157	case IBMVFC_AE_RESUME:
2158		vhost->events_to_log |= IBMVFC_AE_LINKUP;
2159		vhost->delay_init = 1;
2160		__ibmvfc_reset_host(vhost);
2161		break;
2162	case IBMVFC_AE_SCN_FABRIC:
2163	case IBMVFC_AE_SCN_DOMAIN:
2164		vhost->events_to_log |= IBMVFC_AE_RSCN;
2165		vhost->delay_init = 1;
2166		__ibmvfc_reset_host(vhost);
2167		break;
2168	case IBMVFC_AE_SCN_NPORT:
2169	case IBMVFC_AE_SCN_GROUP:
2170		vhost->events_to_log |= IBMVFC_AE_RSCN;
2171	case IBMVFC_AE_ELS_LOGO:
2172	case IBMVFC_AE_ELS_PRLO:
2173	case IBMVFC_AE_ELS_PLOGI:
2174		ibmvfc_reinit_host(vhost);
2175		break;
2176	case IBMVFC_AE_LINK_DOWN:
2177	case IBMVFC_AE_ADAPTER_FAILED:
2178		ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
2179		break;
2180	case IBMVFC_AE_LINK_DEAD:
2181		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
2182		break;
2183	case IBMVFC_AE_HALT:
2184		ibmvfc_link_down(vhost, IBMVFC_HALTED);
2185		break;
2186	default:
2187		dev_err(vhost->dev, "Unknown async event received: %lld\n", crq->event);
2188		break;
2189	};
2190}
2191
2192/**
2193 * ibmvfc_handle_crq - Handles and frees received events in the CRQ
2194 * @crq:	Command/Response queue
2195 * @vhost:	ibmvfc host struct
2196 *
2197 **/
2198static void ibmvfc_handle_crq(struct ibmvfc_crq *crq, struct ibmvfc_host *vhost)
2199{
2200	long rc;
2201	struct ibmvfc_event *evt = (struct ibmvfc_event *)crq->ioba;
2202
2203	switch (crq->valid) {
2204	case IBMVFC_CRQ_INIT_RSP:
2205		switch (crq->format) {
2206		case IBMVFC_CRQ_INIT:
2207			dev_info(vhost->dev, "Partner initialized\n");
2208			/* Send back a response */
2209			rc = ibmvfc_send_crq_init_complete(vhost);
2210			if (rc == 0)
2211				ibmvfc_init_host(vhost, 0);
2212			else
2213				dev_err(vhost->dev, "Unable to send init rsp. rc=%ld\n", rc);
2214			break;
2215		case IBMVFC_CRQ_INIT_COMPLETE:
2216			dev_info(vhost->dev, "Partner initialization complete\n");
2217			ibmvfc_init_host(vhost, 0);
2218			break;
2219		default:
2220			dev_err(vhost->dev, "Unknown crq message type: %d\n", crq->format);
2221		}
2222		return;
2223	case IBMVFC_CRQ_XPORT_EVENT:
2224		vhost->state = IBMVFC_NO_CRQ;
2225		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_NONE);
2226		if (crq->format == IBMVFC_PARTITION_MIGRATED) {
2227			/* We need to re-setup the interpartition connection */
2228			dev_info(vhost->dev, "Re-enabling adapter\n");
2229			vhost->client_migrated = 1;
2230			ibmvfc_purge_requests(vhost, DID_REQUEUE);
2231			if ((rc = ibmvfc_reenable_crq_queue(vhost)) ||
2232			    (rc = ibmvfc_send_crq_init(vhost))) {
2233				ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
2234				dev_err(vhost->dev, "Error after enable (rc=%ld)\n", rc);
2235			} else
2236				ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
2237		} else {
2238			dev_err(vhost->dev, "Virtual adapter failed (rc=%d)\n", crq->format);
2239
2240			ibmvfc_purge_requests(vhost, DID_ERROR);
2241			if ((rc = ibmvfc_reset_crq(vhost)) ||
2242			    (rc = ibmvfc_send_crq_init(vhost))) {
2243				ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
2244				dev_err(vhost->dev, "Error after reset (rc=%ld)\n", rc);
2245			} else
2246				ibmvfc_link_down(vhost, IBMVFC_LINK_DOWN);
2247		}
2248		return;
2249	case IBMVFC_CRQ_CMD_RSP:
2250		break;
2251	default:
2252		dev_err(vhost->dev, "Got an invalid message type 0x%02x\n", crq->valid);
2253		return;
2254	}
2255
2256	if (crq->format == IBMVFC_ASYNC_EVENT)
2257		return;
2258
2259	/* The only kind of payload CRQs we should get are responses to
2260	 * things we send. Make sure this response is to something we
2261	 * actually sent
2262	 */
2263	if (unlikely(!ibmvfc_valid_event(&vhost->pool, evt))) {
2264		dev_err(vhost->dev, "Returned correlation_token 0x%08llx is invalid!\n",
2265			crq->ioba);
2266		return;
2267	}
2268
2269	if (unlikely(atomic_read(&evt->free))) {
2270		dev_err(vhost->dev, "Received duplicate correlation_token 0x%08llx!\n",
2271			crq->ioba);
2272		return;
2273	}
2274
2275	del_timer(&evt->timer);
2276	list_del(&evt->queue);
2277	ibmvfc_trc_end(evt);
2278	evt->done(evt);
2279}
2280
2281/**
2282 * ibmvfc_scan_finished - Check if the device scan is done.
2283 * @shost:	scsi host struct
2284 * @time:	current elapsed time
2285 *
2286 * Returns:
2287 *	0 if scan is not done / 1 if scan is done
2288 **/
2289static int ibmvfc_scan_finished(struct Scsi_Host *shost, unsigned long time)
2290{
2291	unsigned long flags;
2292	struct ibmvfc_host *vhost = shost_priv(shost);
2293	int done = 0;
2294
2295	spin_lock_irqsave(shost->host_lock, flags);
2296	if (time >= (init_timeout * HZ)) {
2297		dev_info(vhost->dev, "Scan taking longer than %d seconds, "
2298			 "continuing initialization\n", init_timeout);
2299		done = 1;
2300	}
2301
2302	if (vhost->state != IBMVFC_NO_CRQ && vhost->action == IBMVFC_HOST_ACTION_NONE)
2303		done = 1;
2304	spin_unlock_irqrestore(shost->host_lock, flags);
2305	return done;
2306}
2307
2308/**
2309 * ibmvfc_slave_alloc - Setup the device's task set value
2310 * @sdev:	struct scsi_device device to configure
2311 *
2312 * Set the device's task set value so that error handling works as
2313 * expected.
2314 *
2315 * Returns:
2316 *	0 on success / -ENXIO if device does not exist
2317 **/
2318static int ibmvfc_slave_alloc(struct scsi_device *sdev)
2319{
2320	struct Scsi_Host *shost = sdev->host;
2321	struct fc_rport *rport = starget_to_rport(scsi_target(sdev));
2322	struct ibmvfc_host *vhost = shost_priv(shost);
2323	unsigned long flags = 0;
2324
2325	if (!rport || fc_remote_port_chkready(rport))
2326		return -ENXIO;
2327
2328	spin_lock_irqsave(shost->host_lock, flags);
2329	sdev->hostdata = (void *)(unsigned long)vhost->task_set++;
2330	spin_unlock_irqrestore(shost->host_lock, flags);
2331	return 0;
2332}
2333
2334/**
2335 * ibmvfc_target_alloc - Setup the target's task set value
2336 * @starget:	struct scsi_target
2337 *
2338 * Set the target's task set value so that error handling works as
2339 * expected.
2340 *
2341 * Returns:
2342 *	0 on success / -ENXIO if device does not exist
2343 **/
2344static int ibmvfc_target_alloc(struct scsi_target *starget)
2345{
2346	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
2347	struct ibmvfc_host *vhost = shost_priv(shost);
2348	unsigned long flags = 0;
2349
2350	spin_lock_irqsave(shost->host_lock, flags);
2351	starget->hostdata = (void *)(unsigned long)vhost->task_set++;
2352	spin_unlock_irqrestore(shost->host_lock, flags);
2353	return 0;
2354}
2355
2356/**
2357 * ibmvfc_slave_configure - Configure the device
2358 * @sdev:	struct scsi_device device to configure
2359 *
2360 * Enable allow_restart for a device if it is a disk. Adjust the
2361 * queue_depth here also.
2362 *
2363 * Returns:
2364 *	0
2365 **/
2366static int ibmvfc_slave_configure(struct scsi_device *sdev)
2367{
2368	struct Scsi_Host *shost = sdev->host;
2369	struct fc_rport *rport = starget_to_rport(sdev->sdev_target);
2370	unsigned long flags = 0;
2371
2372	spin_lock_irqsave(shost->host_lock, flags);
2373	if (sdev->type == TYPE_DISK)
2374		sdev->allow_restart = 1;
2375
2376	if (sdev->tagged_supported) {
2377		scsi_set_tag_type(sdev, MSG_SIMPLE_TAG);
2378		scsi_activate_tcq(sdev, sdev->queue_depth);
2379	} else
2380		scsi_deactivate_tcq(sdev, sdev->queue_depth);
2381
2382	rport->dev_loss_tmo = dev_loss_tmo;
2383	spin_unlock_irqrestore(shost->host_lock, flags);
2384	return 0;
2385}
2386
2387/**
2388 * ibmvfc_change_queue_depth - Change the device's queue depth
2389 * @sdev:	scsi device struct
2390 * @qdepth:	depth to set
2391 *
2392 * Return value:
2393 * 	actual depth set
2394 **/
2395static int ibmvfc_change_queue_depth(struct scsi_device *sdev, int qdepth)
2396{
2397	if (qdepth > IBMVFC_MAX_CMDS_PER_LUN)
2398		qdepth = IBMVFC_MAX_CMDS_PER_LUN;
2399
2400	scsi_adjust_queue_depth(sdev, 0, qdepth);
2401	return sdev->queue_depth;
2402}
2403
2404/**
2405 * ibmvfc_change_queue_type - Change the device's queue type
2406 * @sdev:		scsi device struct
2407 * @tag_type:	type of tags to use
2408 *
2409 * Return value:
2410 * 	actual queue type set
2411 **/
2412static int ibmvfc_change_queue_type(struct scsi_device *sdev, int tag_type)
2413{
2414	if (sdev->tagged_supported) {
2415		scsi_set_tag_type(sdev, tag_type);
2416
2417		if (tag_type)
2418			scsi_activate_tcq(sdev, sdev->queue_depth);
2419		else
2420			scsi_deactivate_tcq(sdev, sdev->queue_depth);
2421	} else
2422		tag_type = 0;
2423
2424	return tag_type;
2425}
2426
2427static ssize_t ibmvfc_show_host_partition_name(struct device *dev,
2428						 struct device_attribute *attr, char *buf)
2429{
2430	struct Scsi_Host *shost = class_to_shost(dev);
2431	struct ibmvfc_host *vhost = shost_priv(shost);
2432
2433	return snprintf(buf, PAGE_SIZE, "%s\n",
2434			vhost->login_buf->resp.partition_name);
2435}
2436
2437static struct device_attribute ibmvfc_host_partition_name = {
2438	.attr = {
2439		.name = "partition_name",
2440		.mode = S_IRUGO,
2441	},
2442	.show = ibmvfc_show_host_partition_name,
2443};
2444
2445static ssize_t ibmvfc_show_host_device_name(struct device *dev,
2446					    struct device_attribute *attr, char *buf)
2447{
2448	struct Scsi_Host *shost = class_to_shost(dev);
2449	struct ibmvfc_host *vhost = shost_priv(shost);
2450
2451	return snprintf(buf, PAGE_SIZE, "%s\n",
2452			vhost->login_buf->resp.device_name);
2453}
2454
2455static struct device_attribute ibmvfc_host_device_name = {
2456	.attr = {
2457		.name = "device_name",
2458		.mode = S_IRUGO,
2459	},
2460	.show = ibmvfc_show_host_device_name,
2461};
2462
2463static ssize_t ibmvfc_show_host_loc_code(struct device *dev,
2464					 struct device_attribute *attr, char *buf)
2465{
2466	struct Scsi_Host *shost = class_to_shost(dev);
2467	struct ibmvfc_host *vhost = shost_priv(shost);
2468
2469	return snprintf(buf, PAGE_SIZE, "%s\n",
2470			vhost->login_buf->resp.port_loc_code);
2471}
2472
2473static struct device_attribute ibmvfc_host_loc_code = {
2474	.attr = {
2475		.name = "port_loc_code",
2476		.mode = S_IRUGO,
2477	},
2478	.show = ibmvfc_show_host_loc_code,
2479};
2480
2481static ssize_t ibmvfc_show_host_drc_name(struct device *dev,
2482					 struct device_attribute *attr, char *buf)
2483{
2484	struct Scsi_Host *shost = class_to_shost(dev);
2485	struct ibmvfc_host *vhost = shost_priv(shost);
2486
2487	return snprintf(buf, PAGE_SIZE, "%s\n",
2488			vhost->login_buf->resp.drc_name);
2489}
2490
2491static struct device_attribute ibmvfc_host_drc_name = {
2492	.attr = {
2493		.name = "drc_name",
2494		.mode = S_IRUGO,
2495	},
2496	.show = ibmvfc_show_host_drc_name,
2497};
2498
2499static ssize_t ibmvfc_show_host_npiv_version(struct device *dev,
2500					     struct device_attribute *attr, char *buf)
2501{
2502	struct Scsi_Host *shost = class_to_shost(dev);
2503	struct ibmvfc_host *vhost = shost_priv(shost);
2504	return snprintf(buf, PAGE_SIZE, "%d\n", vhost->login_buf->resp.version);
2505}
2506
2507static struct device_attribute ibmvfc_host_npiv_version = {
2508	.attr = {
2509		.name = "npiv_version",
2510		.mode = S_IRUGO,
2511	},
2512	.show = ibmvfc_show_host_npiv_version,
2513};
2514
2515/**
2516 * ibmvfc_show_log_level - Show the adapter's error logging level
2517 * @dev:	class device struct
2518 * @buf:	buffer
2519 *
2520 * Return value:
2521 * 	number of bytes printed to buffer
2522 **/
2523static ssize_t ibmvfc_show_log_level(struct device *dev,
2524				     struct device_attribute *attr, char *buf)
2525{
2526	struct Scsi_Host *shost = class_to_shost(dev);
2527	struct ibmvfc_host *vhost = shost_priv(shost);
2528	unsigned long flags = 0;
2529	int len;
2530
2531	spin_lock_irqsave(shost->host_lock, flags);
2532	len = snprintf(buf, PAGE_SIZE, "%d\n", vhost->log_level);
2533	spin_unlock_irqrestore(shost->host_lock, flags);
2534	return len;
2535}
2536
2537/**
2538 * ibmvfc_store_log_level - Change the adapter's error logging level
2539 * @dev:	class device struct
2540 * @buf:	buffer
2541 *
2542 * Return value:
2543 * 	number of bytes printed to buffer
2544 **/
2545static ssize_t ibmvfc_store_log_level(struct device *dev,
2546				      struct device_attribute *attr,
2547				      const char *buf, size_t count)
2548{
2549	struct Scsi_Host *shost = class_to_shost(dev);
2550	struct ibmvfc_host *vhost = shost_priv(shost);
2551	unsigned long flags = 0;
2552
2553	spin_lock_irqsave(shost->host_lock, flags);
2554	vhost->log_level = simple_strtoul(buf, NULL, 10);
2555	spin_unlock_irqrestore(shost->host_lock, flags);
2556	return strlen(buf);
2557}
2558
2559static struct device_attribute ibmvfc_log_level_attr = {
2560	.attr = {
2561		.name =		"log_level",
2562		.mode =		S_IRUGO | S_IWUSR,
2563	},
2564	.show = ibmvfc_show_log_level,
2565	.store = ibmvfc_store_log_level
2566};
2567
2568#ifdef CONFIG_SCSI_IBMVFC_TRACE
2569/**
2570 * ibmvfc_read_trace - Dump the adapter trace
2571 * @kobj:		kobject struct
2572 * @bin_attr:	bin_attribute struct
2573 * @buf:		buffer
2574 * @off:		offset
2575 * @count:		buffer size
2576 *
2577 * Return value:
2578 *	number of bytes printed to buffer
2579 **/
2580static ssize_t ibmvfc_read_trace(struct kobject *kobj,
2581				 struct bin_attribute *bin_attr,
2582				 char *buf, loff_t off, size_t count)
2583{
2584	struct device *dev = container_of(kobj, struct device, kobj);
2585	struct Scsi_Host *shost = class_to_shost(dev);
2586	struct ibmvfc_host *vhost = shost_priv(shost);
2587	unsigned long flags = 0;
2588	int size = IBMVFC_TRACE_SIZE;
2589	char *src = (char *)vhost->trace;
2590
2591	if (off > size)
2592		return 0;
2593	if (off + count > size) {
2594		size -= off;
2595		count = size;
2596	}
2597
2598	spin_lock_irqsave(shost->host_lock, flags);
2599	memcpy(buf, &src[off], count);
2600	spin_unlock_irqrestore(shost->host_lock, flags);
2601	return count;
2602}
2603
2604static struct bin_attribute ibmvfc_trace_attr = {
2605	.attr =	{
2606		.name = "trace",
2607		.mode = S_IRUGO,
2608	},
2609	.size = 0,
2610	.read = ibmvfc_read_trace,
2611};
2612#endif
2613
2614static struct device_attribute *ibmvfc_attrs[] = {
2615	&ibmvfc_host_partition_name,
2616	&ibmvfc_host_device_name,
2617	&ibmvfc_host_loc_code,
2618	&ibmvfc_host_drc_name,
2619	&ibmvfc_host_npiv_version,
2620	&ibmvfc_log_level_attr,
2621	NULL
2622};
2623
2624static struct scsi_host_template driver_template = {
2625	.module = THIS_MODULE,
2626	.name = "IBM POWER Virtual FC Adapter",
2627	.proc_name = IBMVFC_NAME,
2628	.queuecommand = ibmvfc_queuecommand,
2629	.eh_abort_handler = ibmvfc_eh_abort_handler,
2630	.eh_device_reset_handler = ibmvfc_eh_device_reset_handler,
2631	.eh_target_reset_handler = ibmvfc_eh_target_reset_handler,
2632	.eh_host_reset_handler = ibmvfc_eh_host_reset_handler,
2633	.slave_alloc = ibmvfc_slave_alloc,
2634	.slave_configure = ibmvfc_slave_configure,
2635	.target_alloc = ibmvfc_target_alloc,
2636	.scan_finished = ibmvfc_scan_finished,
2637	.change_queue_depth = ibmvfc_change_queue_depth,
2638	.change_queue_type = ibmvfc_change_queue_type,
2639	.cmd_per_lun = 16,
2640	.can_queue = IBMVFC_MAX_REQUESTS_DEFAULT,
2641	.this_id = -1,
2642	.sg_tablesize = SG_ALL,
2643	.max_sectors = IBMVFC_MAX_SECTORS,
2644	.use_clustering = ENABLE_CLUSTERING,
2645	.shost_attrs = ibmvfc_attrs,
2646};
2647
2648/**
2649 * ibmvfc_next_async_crq - Returns the next entry in async queue
2650 * @vhost:	ibmvfc host struct
2651 *
2652 * Returns:
2653 *	Pointer to next entry in queue / NULL if empty
2654 **/
2655static struct ibmvfc_async_crq *ibmvfc_next_async_crq(struct ibmvfc_host *vhost)
2656{
2657	struct ibmvfc_async_crq_queue *async_crq = &vhost->async_crq;
2658	struct ibmvfc_async_crq *crq;
2659
2660	crq = &async_crq->msgs[async_crq->cur];
2661	if (crq->valid & 0x80) {
2662		if (++async_crq->cur == async_crq->size)
2663			async_crq->cur = 0;
2664	} else
2665		crq = NULL;
2666
2667	return crq;
2668}
2669
2670/**
2671 * ibmvfc_next_crq - Returns the next entry in message queue
2672 * @vhost:	ibmvfc host struct
2673 *
2674 * Returns:
2675 *	Pointer to next entry in queue / NULL if empty
2676 **/
2677static struct ibmvfc_crq *ibmvfc_next_crq(struct ibmvfc_host *vhost)
2678{
2679	struct ibmvfc_crq_queue *queue = &vhost->crq;
2680	struct ibmvfc_crq *crq;
2681
2682	crq = &queue->msgs[queue->cur];
2683	if (crq->valid & 0x80) {
2684		if (++queue->cur == queue->size)
2685			queue->cur = 0;
2686	} else
2687		crq = NULL;
2688
2689	return crq;
2690}
2691
2692/**
2693 * ibmvfc_interrupt - Interrupt handler
2694 * @irq:		number of irq to handle, not used
2695 * @dev_instance: ibmvfc_host that received interrupt
2696 *
2697 * Returns:
2698 *	IRQ_HANDLED
2699 **/
2700static irqreturn_t ibmvfc_interrupt(int irq, void *dev_instance)
2701{
2702	struct ibmvfc_host *vhost = (struct ibmvfc_host *)dev_instance;
2703	unsigned long flags;
2704
2705	spin_lock_irqsave(vhost->host->host_lock, flags);
2706	vio_disable_interrupts(to_vio_dev(vhost->dev));
2707	tasklet_schedule(&vhost->tasklet);
2708	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2709	return IRQ_HANDLED;
2710}
2711
2712/**
2713 * ibmvfc_tasklet - Interrupt handler tasklet
2714 * @data:		ibmvfc host struct
2715 *
2716 * Returns:
2717 *	Nothing
2718 **/
2719static void ibmvfc_tasklet(void *data)
2720{
2721	struct ibmvfc_host *vhost = data;
2722	struct vio_dev *vdev = to_vio_dev(vhost->dev);
2723	struct ibmvfc_crq *crq;
2724	struct ibmvfc_async_crq *async;
2725	unsigned long flags;
2726	int done = 0;
2727
2728	spin_lock_irqsave(vhost->host->host_lock, flags);
2729	while (!done) {
2730		/* Pull all the valid messages off the CRQ */
2731		while ((crq = ibmvfc_next_crq(vhost)) != NULL) {
2732			ibmvfc_handle_crq(crq, vhost);
2733			crq->valid = 0;
2734		}
2735
2736		/* Pull all the valid messages off the async CRQ */
2737		while ((async = ibmvfc_next_async_crq(vhost)) != NULL) {
2738			ibmvfc_handle_async(async, vhost);
2739			async->valid = 0;
2740		}
2741
2742		vio_enable_interrupts(vdev);
2743		if ((crq = ibmvfc_next_crq(vhost)) != NULL) {
2744			vio_disable_interrupts(vdev);
2745			ibmvfc_handle_crq(crq, vhost);
2746			crq->valid = 0;
2747		} else if ((async = ibmvfc_next_async_crq(vhost)) != NULL) {
2748			vio_disable_interrupts(vdev);
2749			ibmvfc_handle_async(async, vhost);
2750			async->valid = 0;
2751		} else
2752			done = 1;
2753	}
2754
2755	spin_unlock_irqrestore(vhost->host->host_lock, flags);
2756}
2757
2758/**
2759 * ibmvfc_init_tgt - Set the next init job step for the target
2760 * @tgt:		ibmvfc target struct
2761 * @job_step:	job step to perform
2762 *
2763 **/
2764static void ibmvfc_init_tgt(struct ibmvfc_target *tgt,
2765			    void (*job_step) (struct ibmvfc_target *))
2766{
2767	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT);
2768	tgt->job_step = job_step;
2769	wake_up(&tgt->vhost->work_wait_q);
2770}
2771
2772/**
2773 * ibmvfc_retry_tgt_init - Attempt to retry a step in target initialization
2774 * @tgt:		ibmvfc target struct
2775 * @job_step:	initialization job step
2776 *
2777 **/
2778static void ibmvfc_retry_tgt_init(struct ibmvfc_target *tgt,
2779				  void (*job_step) (struct ibmvfc_target *))
2780{
2781	if (++tgt->init_retries > IBMVFC_MAX_TGT_INIT_RETRIES) {
2782		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
2783		wake_up(&tgt->vhost->work_wait_q);
2784	} else
2785		ibmvfc_init_tgt(tgt, job_step);
2786}
2787
2788/* Defined in FC-LS */
2789static const struct {
2790	int code;
2791	int retry;
2792	int logged_in;
2793} prli_rsp [] = {
2794	{ 0, 1, 0 },
2795	{ 1, 0, 1 },
2796	{ 2, 1, 0 },
2797	{ 3, 1, 0 },
2798	{ 4, 0, 0 },
2799	{ 5, 0, 0 },
2800	{ 6, 0, 1 },
2801	{ 7, 0, 0 },
2802	{ 8, 1, 0 },
2803};
2804
2805/**
2806 * ibmvfc_get_prli_rsp - Find PRLI response index
2807 * @flags:	PRLI response flags
2808 *
2809 **/
2810static int ibmvfc_get_prli_rsp(u16 flags)
2811{
2812	int i;
2813	int code = (flags & 0x0f00) >> 8;
2814
2815	for (i = 0; i < ARRAY_SIZE(prli_rsp); i++)
2816		if (prli_rsp[i].code == code)
2817			return i;
2818
2819	return 0;
2820}
2821
2822/**
2823 * ibmvfc_tgt_prli_done - Completion handler for Process Login
2824 * @evt:	ibmvfc event struct
2825 *
2826 **/
2827static void ibmvfc_tgt_prli_done(struct ibmvfc_event *evt)
2828{
2829	struct ibmvfc_target *tgt = evt->tgt;
2830	struct ibmvfc_host *vhost = evt->vhost;
2831	struct ibmvfc_process_login *rsp = &evt->xfer_iu->prli;
2832	struct ibmvfc_prli_svc_parms *parms = &rsp->parms;
2833	u32 status = rsp->common.status;
2834	int index;
2835
2836	vhost->discovery_threads--;
2837	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
2838	switch (status) {
2839	case IBMVFC_MAD_SUCCESS:
2840		tgt_dbg(tgt, "Process Login succeeded: %X %02X %04X\n",
2841			parms->type, parms->flags, parms->service_parms);
2842
2843		if (parms->type == IBMVFC_SCSI_FCP_TYPE) {
2844			index = ibmvfc_get_prli_rsp(parms->flags);
2845			if (prli_rsp[index].logged_in) {
2846				if (parms->flags & IBMVFC_PRLI_EST_IMG_PAIR) {
2847					tgt->need_login = 0;
2848					tgt->ids.roles = 0;
2849					if (parms->service_parms & IBMVFC_PRLI_TARGET_FUNC)
2850						tgt->ids.roles |= FC_PORT_ROLE_FCP_TARGET;
2851					if (parms->service_parms & IBMVFC_PRLI_INITIATOR_FUNC)
2852						tgt->ids.roles |= FC_PORT_ROLE_FCP_INITIATOR;
2853					ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_ADD_RPORT);
2854				} else
2855					ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
2856			} else if (prli_rsp[index].retry)
2857				ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_prli);
2858			else
2859				ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
2860		} else
2861			ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
2862		break;
2863	case IBMVFC_MAD_DRIVER_FAILED:
2864		break;
2865	case IBMVFC_MAD_CRQ_ERROR:
2866		ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_prli);
2867		break;
2868	case IBMVFC_MAD_FAILED:
2869	default:
2870		tgt_err(tgt, "Process Login failed: %s (%x:%x) rc=0x%02X\n",
2871			ibmvfc_get_cmd_error(rsp->status, rsp->error),
2872			rsp->status, rsp->error, status);
2873		if (ibmvfc_retry_cmd(rsp->status, rsp->error))
2874			ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_prli);
2875		else
2876			ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
2877		break;
2878	};
2879
2880	kref_put(&tgt->kref, ibmvfc_release_tgt);
2881	ibmvfc_free_event(evt);
2882	wake_up(&vhost->work_wait_q);
2883}
2884
2885/**
2886 * ibmvfc_tgt_send_prli - Send a process login
2887 * @tgt:	ibmvfc target struct
2888 *
2889 **/
2890static void ibmvfc_tgt_send_prli(struct ibmvfc_target *tgt)
2891{
2892	struct ibmvfc_process_login *prli;
2893	struct ibmvfc_host *vhost = tgt->vhost;
2894	struct ibmvfc_event *evt;
2895
2896	if (vhost->discovery_threads >= disc_threads)
2897		return;
2898
2899	kref_get(&tgt->kref);
2900	evt = ibmvfc_get_event(vhost);
2901	vhost->discovery_threads++;
2902	ibmvfc_init_event(evt, ibmvfc_tgt_prli_done, IBMVFC_MAD_FORMAT);
2903	evt->tgt = tgt;
2904	prli = &evt->iu.prli;
2905	memset(prli, 0, sizeof(*prli));
2906	prli->common.version = 1;
2907	prli->common.opcode = IBMVFC_PROCESS_LOGIN;
2908	prli->common.length = sizeof(*prli);
2909	prli->scsi_id = tgt->scsi_id;
2910
2911	prli->parms.type = IBMVFC_SCSI_FCP_TYPE;
2912	prli->parms.flags = IBMVFC_PRLI_EST_IMG_PAIR;
2913	prli->parms.service_parms = IBMVFC_PRLI_INITIATOR_FUNC;
2914
2915	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
2916	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
2917		vhost->discovery_threads--;
2918		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
2919		kref_put(&tgt->kref, ibmvfc_release_tgt);
2920	} else
2921		tgt_dbg(tgt, "Sent process login\n");
2922}
2923
2924/**
2925 * ibmvfc_tgt_plogi_done - Completion handler for Port Login
2926 * @evt:	ibmvfc event struct
2927 *
2928 **/
2929static void ibmvfc_tgt_plogi_done(struct ibmvfc_event *evt)
2930{
2931	struct ibmvfc_target *tgt = evt->tgt;
2932	struct ibmvfc_host *vhost = evt->vhost;
2933	struct ibmvfc_port_login *rsp = &evt->xfer_iu->plogi;
2934	u32 status = rsp->common.status;
2935
2936	vhost->discovery_threads--;
2937	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
2938	switch (status) {
2939	case IBMVFC_MAD_SUCCESS:
2940		tgt_dbg(tgt, "Port Login succeeded\n");
2941		if (tgt->ids.port_name &&
2942		    tgt->ids.port_name != wwn_to_u64(rsp->service_parms.port_name)) {
2943			vhost->reinit = 1;
2944			tgt_dbg(tgt, "Port re-init required\n");
2945			break;
2946		}
2947		tgt->ids.node_name = wwn_to_u64(rsp->service_parms.node_name);
2948		tgt->ids.port_name = wwn_to_u64(rsp->service_parms.port_name);
2949		tgt->ids.port_id = tgt->scsi_id;
2950		memcpy(&tgt->service_parms, &rsp->service_parms,
2951		       sizeof(tgt->service_parms));
2952		memcpy(&tgt->service_parms_change, &rsp->service_parms_change,
2953		       sizeof(tgt->service_parms_change));
2954		ibmvfc_init_tgt(tgt, ibmvfc_tgt_send_prli);
2955		break;
2956	case IBMVFC_MAD_DRIVER_FAILED:
2957		break;
2958	case IBMVFC_MAD_CRQ_ERROR:
2959		ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_plogi);
2960		break;
2961	case IBMVFC_MAD_FAILED:
2962	default:
2963		tgt_err(tgt, "Port Login failed: %s (%x:%x) %s (%x) %s (%x) rc=0x%02X\n",
2964			ibmvfc_get_cmd_error(rsp->status, rsp->error), rsp->status, rsp->error,
2965			ibmvfc_get_fc_type(rsp->fc_type), rsp->fc_type,
2966			ibmvfc_get_ls_explain(rsp->fc_explain), rsp->fc_explain, status);
2967
2968		if (ibmvfc_retry_cmd(rsp->status, rsp->error))
2969			ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_send_plogi);
2970		else
2971			ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
2972		break;
2973	};
2974
2975	kref_put(&tgt->kref, ibmvfc_release_tgt);
2976	ibmvfc_free_event(evt);
2977	wake_up(&vhost->work_wait_q);
2978}
2979
2980/**
2981 * ibmvfc_tgt_send_plogi - Send PLOGI to the specified target
2982 * @tgt:	ibmvfc target struct
2983 *
2984 **/
2985static void ibmvfc_tgt_send_plogi(struct ibmvfc_target *tgt)
2986{
2987	struct ibmvfc_port_login *plogi;
2988	struct ibmvfc_host *vhost = tgt->vhost;
2989	struct ibmvfc_event *evt;
2990
2991	if (vhost->discovery_threads >= disc_threads)
2992		return;
2993
2994	kref_get(&tgt->kref);
2995	evt = ibmvfc_get_event(vhost);
2996	vhost->discovery_threads++;
2997	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
2998	ibmvfc_init_event(evt, ibmvfc_tgt_plogi_done, IBMVFC_MAD_FORMAT);
2999	evt->tgt = tgt;
3000	plogi = &evt->iu.plogi;
3001	memset(plogi, 0, sizeof(*plogi));
3002	plogi->common.version = 1;
3003	plogi->common.opcode = IBMVFC_PORT_LOGIN;
3004	plogi->common.length = sizeof(*plogi);
3005	plogi->scsi_id = tgt->scsi_id;
3006
3007	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
3008		vhost->discovery_threads--;
3009		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3010		kref_put(&tgt->kref, ibmvfc_release_tgt);
3011	} else
3012		tgt_dbg(tgt, "Sent port login\n");
3013}
3014
3015/**
3016 * ibmvfc_tgt_implicit_logout_done - Completion handler for Implicit Logout MAD
3017 * @evt:	ibmvfc event struct
3018 *
3019 **/
3020static void ibmvfc_tgt_implicit_logout_done(struct ibmvfc_event *evt)
3021{
3022	struct ibmvfc_target *tgt = evt->tgt;
3023	struct ibmvfc_host *vhost = evt->vhost;
3024	struct ibmvfc_implicit_logout *rsp = &evt->xfer_iu->implicit_logout;
3025	u32 status = rsp->common.status;
3026
3027	vhost->discovery_threads--;
3028	ibmvfc_free_event(evt);
3029	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3030
3031	switch (status) {
3032	case IBMVFC_MAD_SUCCESS:
3033		tgt_dbg(tgt, "Implicit Logout succeeded\n");
3034		break;
3035	case IBMVFC_MAD_DRIVER_FAILED:
3036		kref_put(&tgt->kref, ibmvfc_release_tgt);
3037		wake_up(&vhost->work_wait_q);
3038		return;
3039	case IBMVFC_MAD_FAILED:
3040	default:
3041		tgt_err(tgt, "Implicit Logout failed: rc=0x%02X\n", status);
3042		break;
3043	};
3044
3045	if (vhost->action == IBMVFC_HOST_ACTION_TGT_INIT)
3046		ibmvfc_init_tgt(tgt, ibmvfc_tgt_send_plogi);
3047	else if (vhost->action == IBMVFC_HOST_ACTION_QUERY_TGTS &&
3048		 tgt->scsi_id != tgt->new_scsi_id)
3049		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3050	kref_put(&tgt->kref, ibmvfc_release_tgt);
3051	wake_up(&vhost->work_wait_q);
3052}
3053
3054/**
3055 * ibmvfc_tgt_implicit_logout - Initiate an Implicit Logout for specified target
3056 * @tgt:		ibmvfc target struct
3057 *
3058 **/
3059static void ibmvfc_tgt_implicit_logout(struct ibmvfc_target *tgt)
3060{
3061	struct ibmvfc_implicit_logout *mad;
3062	struct ibmvfc_host *vhost = tgt->vhost;
3063	struct ibmvfc_event *evt;
3064
3065	if (vhost->discovery_threads >= disc_threads)
3066		return;
3067
3068	kref_get(&tgt->kref);
3069	evt = ibmvfc_get_event(vhost);
3070	vhost->discovery_threads++;
3071	ibmvfc_init_event(evt, ibmvfc_tgt_implicit_logout_done, IBMVFC_MAD_FORMAT);
3072	evt->tgt = tgt;
3073	mad = &evt->iu.implicit_logout;
3074	memset(mad, 0, sizeof(*mad));
3075	mad->common.version = 1;
3076	mad->common.opcode = IBMVFC_IMPLICIT_LOGOUT;
3077	mad->common.length = sizeof(*mad);
3078	mad->old_scsi_id = tgt->scsi_id;
3079
3080	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
3081	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
3082		vhost->discovery_threads--;
3083		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3084		kref_put(&tgt->kref, ibmvfc_release_tgt);
3085	} else
3086		tgt_dbg(tgt, "Sent Implicit Logout\n");
3087}
3088
3089/**
3090 * ibmvfc_adisc_needs_plogi - Does device need PLOGI?
3091 * @mad:	ibmvfc passthru mad struct
3092 * @tgt:	ibmvfc target struct
3093 *
3094 * Returns:
3095 *	1 if PLOGI needed / 0 if PLOGI not needed
3096 **/
3097static int ibmvfc_adisc_needs_plogi(struct ibmvfc_passthru_mad *mad,
3098				    struct ibmvfc_target *tgt)
3099{
3100	if (memcmp(&mad->fc_iu.response[2], &tgt->ids.port_name,
3101		   sizeof(tgt->ids.port_name)))
3102		return 1;
3103	if (memcmp(&mad->fc_iu.response[4], &tgt->ids.node_name,
3104		   sizeof(tgt->ids.node_name)))
3105		return 1;
3106	if (mad->fc_iu.response[6] != tgt->scsi_id)
3107		return 1;
3108	return 0;
3109}
3110
3111/**
3112 * ibmvfc_tgt_adisc_done - Completion handler for ADISC
3113 * @evt:	ibmvfc event struct
3114 *
3115 **/
3116static void ibmvfc_tgt_adisc_done(struct ibmvfc_event *evt)
3117{
3118	struct ibmvfc_target *tgt = evt->tgt;
3119	struct ibmvfc_host *vhost = evt->vhost;
3120	struct ibmvfc_passthru_mad *mad = &evt->xfer_iu->passthru;
3121	u32 status = mad->common.status;
3122	u8 fc_reason, fc_explain;
3123
3124	vhost->discovery_threads--;
3125	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3126
3127	switch (status) {
3128	case IBMVFC_MAD_SUCCESS:
3129		tgt_dbg(tgt, "ADISC succeeded\n");
3130		if (ibmvfc_adisc_needs_plogi(mad, tgt))
3131			tgt->need_login = 1;
3132		break;
3133	case IBMVFC_MAD_DRIVER_FAILED:
3134		break;
3135	case IBMVFC_MAD_FAILED:
3136	default:
3137		tgt->need_login = 1;
3138		fc_reason = (mad->fc_iu.response[1] & 0x00ff0000) >> 16;
3139		fc_explain = (mad->fc_iu.response[1] & 0x0000ff00) >> 8;
3140		tgt_info(tgt, "ADISC failed: %s (%x:%x) %s (%x) %s (%x) rc=0x%02X\n",
3141			 ibmvfc_get_cmd_error(mad->iu.status, mad->iu.error),
3142			 mad->iu.status, mad->iu.error,
3143			 ibmvfc_get_fc_type(fc_reason), fc_reason,
3144			 ibmvfc_get_ls_explain(fc_explain), fc_explain, status);
3145		break;
3146	};
3147
3148	kref_put(&tgt->kref, ibmvfc_release_tgt);
3149	ibmvfc_free_event(evt);
3150	wake_up(&vhost->work_wait_q);
3151}
3152
3153/**
3154 * ibmvfc_init_passthru - Initialize an event struct for FC passthru
3155 * @evt:		ibmvfc event struct
3156 *
3157 **/
3158static void ibmvfc_init_passthru(struct ibmvfc_event *evt)
3159{
3160	struct ibmvfc_passthru_mad *mad = &evt->iu.passthru;
3161
3162	memset(mad, 0, sizeof(*mad));
3163	mad->common.version = 1;
3164	mad->common.opcode = IBMVFC_PASSTHRU;
3165	mad->common.length = sizeof(*mad) - sizeof(mad->fc_iu) - sizeof(mad->iu);
3166	mad->cmd_ioba.va = (u64)evt->crq.ioba +
3167		offsetof(struct ibmvfc_passthru_mad, iu);
3168	mad->cmd_ioba.len = sizeof(mad->iu);
3169	mad->iu.cmd_len = sizeof(mad->fc_iu.payload);
3170	mad->iu.rsp_len = sizeof(mad->fc_iu.response);
3171	mad->iu.cmd.va = (u64)evt->crq.ioba +
3172		offsetof(struct ibmvfc_passthru_mad, fc_iu) +
3173		offsetof(struct ibmvfc_passthru_fc_iu, payload);
3174	mad->iu.cmd.len = sizeof(mad->fc_iu.payload);
3175	mad->iu.rsp.va = (u64)evt->crq.ioba +
3176		offsetof(struct ibmvfc_passthru_mad, fc_iu) +
3177		offsetof(struct ibmvfc_passthru_fc_iu, response);
3178	mad->iu.rsp.len = sizeof(mad->fc_iu.response);
3179}
3180
3181/**
3182 * ibmvfc_tgt_adisc - Initiate an ADISC for specified target
3183 * @tgt:		ibmvfc target struct
3184 *
3185 **/
3186static void ibmvfc_tgt_adisc(struct ibmvfc_target *tgt)
3187{
3188	struct ibmvfc_passthru_mad *mad;
3189	struct ibmvfc_host *vhost = tgt->vhost;
3190	struct ibmvfc_event *evt;
3191
3192	if (vhost->discovery_threads >= disc_threads)
3193		return;
3194
3195	kref_get(&tgt->kref);
3196	evt = ibmvfc_get_event(vhost);
3197	vhost->discovery_threads++;
3198	ibmvfc_init_event(evt, ibmvfc_tgt_adisc_done, IBMVFC_MAD_FORMAT);
3199	evt->tgt = tgt;
3200
3201	ibmvfc_init_passthru(evt);
3202	mad = &evt->iu.passthru;
3203	mad->iu.flags = IBMVFC_FC_ELS;
3204	mad->iu.scsi_id = tgt->scsi_id;
3205
3206	mad->fc_iu.payload[0] = IBMVFC_ADISC;
3207	memcpy(&mad->fc_iu.payload[2], &vhost->login_buf->resp.port_name,
3208	       sizeof(vhost->login_buf->resp.port_name));
3209	memcpy(&mad->fc_iu.payload[4], &vhost->login_buf->resp.node_name,
3210	       sizeof(vhost->login_buf->resp.node_name));
3211	mad->fc_iu.payload[6] = vhost->login_buf->resp.scsi_id & 0x00ffffff;
3212
3213	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
3214	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
3215		vhost->discovery_threads--;
3216		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3217		kref_put(&tgt->kref, ibmvfc_release_tgt);
3218	} else
3219		tgt_dbg(tgt, "Sent ADISC\n");
3220}
3221
3222/**
3223 * ibmvfc_tgt_query_target_done - Completion handler for Query Target MAD
3224 * @evt:	ibmvfc event struct
3225 *
3226 **/
3227static void ibmvfc_tgt_query_target_done(struct ibmvfc_event *evt)
3228{
3229	struct ibmvfc_target *tgt = evt->tgt;
3230	struct ibmvfc_host *vhost = evt->vhost;
3231	struct ibmvfc_query_tgt *rsp = &evt->xfer_iu->query_tgt;
3232	u32 status = rsp->common.status;
3233
3234	vhost->discovery_threads--;
3235	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3236	switch (status) {
3237	case IBMVFC_MAD_SUCCESS:
3238		tgt_dbg(tgt, "Query Target succeeded\n");
3239		tgt->new_scsi_id = rsp->scsi_id;
3240		if (rsp->scsi_id != tgt->scsi_id)
3241			ibmvfc_init_tgt(tgt, ibmvfc_tgt_implicit_logout);
3242		else
3243			ibmvfc_init_tgt(tgt, ibmvfc_tgt_adisc);
3244		break;
3245	case IBMVFC_MAD_DRIVER_FAILED:
3246		break;
3247	case IBMVFC_MAD_CRQ_ERROR:
3248		ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_query_target);
3249		break;
3250	case IBMVFC_MAD_FAILED:
3251	default:
3252		tgt_err(tgt, "Query Target failed: %s (%x:%x) %s (%x) %s (%x) rc=0x%02X\n",
3253			ibmvfc_get_cmd_error(rsp->status, rsp->error), rsp->status, rsp->error,
3254			ibmvfc_get_fc_type(rsp->fc_type), rsp->fc_type,
3255			ibmvfc_get_gs_explain(rsp->fc_explain), rsp->fc_explain, status);
3256
3257		if ((rsp->status & IBMVFC_FABRIC_MAPPED) == IBMVFC_FABRIC_MAPPED &&
3258		    rsp->error == IBMVFC_UNABLE_TO_PERFORM_REQ &&
3259		    rsp->fc_explain == IBMVFC_PORT_NAME_NOT_REG)
3260			ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3261		else if (ibmvfc_retry_cmd(rsp->status, rsp->error))
3262			ibmvfc_retry_tgt_init(tgt, ibmvfc_tgt_query_target);
3263		else
3264			ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_DEL_RPORT);
3265		break;
3266	};
3267
3268	kref_put(&tgt->kref, ibmvfc_release_tgt);
3269	ibmvfc_free_event(evt);
3270	wake_up(&vhost->work_wait_q);
3271}
3272
3273/**
3274 * ibmvfc_tgt_query_target - Initiate a Query Target for specified target
3275 * @tgt:	ibmvfc target struct
3276 *
3277 **/
3278static void ibmvfc_tgt_query_target(struct ibmvfc_target *tgt)
3279{
3280	struct ibmvfc_query_tgt *query_tgt;
3281	struct ibmvfc_host *vhost = tgt->vhost;
3282	struct ibmvfc_event *evt;
3283
3284	if (vhost->discovery_threads >= disc_threads)
3285		return;
3286
3287	kref_get(&tgt->kref);
3288	evt = ibmvfc_get_event(vhost);
3289	vhost->discovery_threads++;
3290	evt->tgt = tgt;
3291	ibmvfc_init_event(evt, ibmvfc_tgt_query_target_done, IBMVFC_MAD_FORMAT);
3292	query_tgt = &evt->iu.query_tgt;
3293	memset(query_tgt, 0, sizeof(*query_tgt));
3294	query_tgt->common.version = 1;
3295	query_tgt->common.opcode = IBMVFC_QUERY_TARGET;
3296	query_tgt->common.length = sizeof(*query_tgt);
3297	query_tgt->wwpn = tgt->ids.port_name;
3298
3299	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_INIT_WAIT);
3300	if (ibmvfc_send_event(evt, vhost, default_timeout)) {
3301		vhost->discovery_threads--;
3302		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3303		kref_put(&tgt->kref, ibmvfc_release_tgt);
3304	} else
3305		tgt_dbg(tgt, "Sent Query Target\n");
3306}
3307
3308/**
3309 * ibmvfc_alloc_target - Allocate and initialize an ibmvfc target
3310 * @vhost:		ibmvfc host struct
3311 * @scsi_id:	SCSI ID to allocate target for
3312 *
3313 * Returns:
3314 *	0 on success / other on failure
3315 **/
3316static int ibmvfc_alloc_target(struct ibmvfc_host *vhost, u64 scsi_id)
3317{
3318	struct ibmvfc_target *tgt;
3319	unsigned long flags;
3320
3321	spin_lock_irqsave(vhost->host->host_lock, flags);
3322	list_for_each_entry(tgt, &vhost->targets, queue) {
3323		if (tgt->scsi_id == scsi_id) {
3324			if (tgt->need_login)
3325				ibmvfc_init_tgt(tgt, ibmvfc_tgt_implicit_logout);
3326			goto unlock_out;
3327		}
3328	}
3329	spin_unlock_irqrestore(vhost->host->host_lock, flags);
3330
3331	tgt = mempool_alloc(vhost->tgt_pool, GFP_KERNEL);
3332	if (!tgt) {
3333		dev_err(vhost->dev, "Target allocation failure for scsi id %08llx\n",
3334			scsi_id);
3335		return -ENOMEM;
3336	}
3337
3338	memset(tgt, 0, sizeof(*tgt));
3339	tgt->scsi_id = scsi_id;
3340	tgt->new_scsi_id = scsi_id;
3341	tgt->vhost = vhost;
3342	tgt->need_login = 1;
3343	kref_init(&tgt->kref);
3344	ibmvfc_init_tgt(tgt, ibmvfc_tgt_implicit_logout);
3345	spin_lock_irqsave(vhost->host->host_lock, flags);
3346	list_add_tail(&tgt->queue, &vhost->targets);
3347
3348unlock_out:
3349	spin_unlock_irqrestore(vhost->host->host_lock, flags);
3350	return 0;
3351}
3352
3353/**
3354 * ibmvfc_alloc_targets - Allocate and initialize ibmvfc targets
3355 * @vhost:		ibmvfc host struct
3356 *
3357 * Returns:
3358 *	0 on success / other on failure
3359 **/
3360static int ibmvfc_alloc_targets(struct ibmvfc_host *vhost)
3361{
3362	int i, rc;
3363
3364	for (i = 0, rc = 0; !rc && i < vhost->num_targets; i++)
3365		rc = ibmvfc_alloc_target(vhost,
3366					 vhost->disc_buf->scsi_id[i] & IBMVFC_DISC_TGT_SCSI_ID_MASK);
3367
3368	return rc;
3369}
3370
3371/**
3372 * ibmvfc_discover_targets_done - Completion handler for discover targets MAD
3373 * @evt:	ibmvfc event struct
3374 *
3375 **/
3376static void ibmvfc_discover_targets_done(struct ibmvfc_event *evt)
3377{
3378	struct ibmvfc_host *vhost = evt->vhost;
3379	struct ibmvfc_discover_targets *rsp = &evt->xfer_iu->discover_targets;
3380	u32 mad_status = rsp->common.status;
3381
3382	switch (mad_status) {
3383	case IBMVFC_MAD_SUCCESS:
3384		ibmvfc_dbg(vhost, "Discover Targets succeeded\n");
3385		vhost->num_targets = rsp->num_written;
3386		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_ALLOC_TGTS);
3387		break;
3388	case IBMVFC_MAD_FAILED:
3389		dev_err(vhost->dev, "Discover Targets failed: %s (%x:%x)\n",
3390			ibmvfc_get_cmd_error(rsp->status, rsp->error), rsp->status, rsp->error);
3391		ibmvfc_retry_host_init(vhost);
3392		break;
3393	case IBMVFC_MAD_DRIVER_FAILED:
3394		break;
3395	default:
3396		dev_err(vhost->dev, "Invalid Discover Targets response: 0x%x\n", mad_status);
3397		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3398		break;
3399	}
3400
3401	ibmvfc_free_event(evt);
3402	wake_up(&vhost->work_wait_q);
3403}
3404
3405/**
3406 * ibmvfc_discover_targets - Send Discover Targets MAD
3407 * @vhost:	ibmvfc host struct
3408 *
3409 **/
3410static void ibmvfc_discover_targets(struct ibmvfc_host *vhost)
3411{
3412	struct ibmvfc_discover_targets *mad;
3413	struct ibmvfc_event *evt = ibmvfc_get_event(vhost);
3414
3415	ibmvfc_init_event(evt, ibmvfc_discover_targets_done, IBMVFC_MAD_FORMAT);
3416	mad = &evt->iu.discover_targets;
3417	memset(mad, 0, sizeof(*mad));
3418	mad->common.version = 1;
3419	mad->common.opcode = IBMVFC_DISC_TARGETS;
3420	mad->common.length = sizeof(*mad);
3421	mad->bufflen = vhost->disc_buf_sz;
3422	mad->buffer.va = vhost->disc_buf_dma;
3423	mad->buffer.len = vhost->disc_buf_sz;
3424	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT_WAIT);
3425
3426	if (!ibmvfc_send_event(evt, vhost, default_timeout))
3427		ibmvfc_dbg(vhost, "Sent discover targets\n");
3428	else
3429		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3430}
3431
3432/**
3433 * ibmvfc_npiv_login_done - Completion handler for NPIV Login
3434 * @evt:	ibmvfc event struct
3435 *
3436 **/
3437static void ibmvfc_npiv_login_done(struct ibmvfc_event *evt)
3438{
3439	struct ibmvfc_host *vhost = evt->vhost;
3440	u32 mad_status = evt->xfer_iu->npiv_login.common.status;
3441	struct ibmvfc_npiv_login_resp *rsp = &vhost->login_buf->resp;
3442	unsigned int npiv_max_sectors;
3443
3444	switch (mad_status) {
3445	case IBMVFC_MAD_SUCCESS:
3446		ibmvfc_free_event(evt);
3447		break;
3448	case IBMVFC_MAD_FAILED:
3449		dev_err(vhost->dev, "NPIV Login failed: %s (%x:%x)\n",
3450			ibmvfc_get_cmd_error(rsp->status, rsp->error), rsp->status, rsp->error);
3451		if (ibmvfc_retry_cmd(rsp->status, rsp->error))
3452			ibmvfc_retry_host_init(vhost);
3453		else
3454			ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3455		ibmvfc_free_event(evt);
3456		return;
3457	case IBMVFC_MAD_CRQ_ERROR:
3458		ibmvfc_retry_host_init(vhost);
3459	case IBMVFC_MAD_DRIVER_FAILED:
3460		ibmvfc_free_event(evt);
3461		return;
3462	default:
3463		dev_err(vhost->dev, "Invalid NPIV Login response: 0x%x\n", mad_status);
3464		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3465		ibmvfc_free_event(evt);
3466		return;
3467	}
3468
3469	vhost->client_migrated = 0;
3470
3471	if (!(rsp->flags & IBMVFC_NATIVE_FC)) {
3472		dev_err(vhost->dev, "Virtual adapter does not support FC. %x\n",
3473			rsp->flags);
3474		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3475		wake_up(&vhost->work_wait_q);
3476		return;
3477	}
3478
3479	if (rsp->max_cmds <= IBMVFC_NUM_INTERNAL_REQ) {
3480		dev_err(vhost->dev, "Virtual adapter supported queue depth too small: %d\n",
3481			rsp->max_cmds);
3482		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3483		wake_up(&vhost->work_wait_q);
3484		return;
3485	}
3486
3487	npiv_max_sectors = min((uint)(rsp->max_dma_len >> 9), IBMVFC_MAX_SECTORS);
3488	dev_info(vhost->dev, "Host partition: %s, device: %s %s %s max sectors %u\n",
3489		 rsp->partition_name, rsp->device_name, rsp->port_loc_code,
3490		 rsp->drc_name, npiv_max_sectors);
3491
3492	fc_host_fabric_name(vhost->host) = rsp->node_name;
3493	fc_host_node_name(vhost->host) = rsp->node_name;
3494	fc_host_port_name(vhost->host) = rsp->port_name;
3495	fc_host_port_id(vhost->host) = rsp->scsi_id;
3496	fc_host_port_type(vhost->host) = FC_PORTTYPE_NPIV;
3497	fc_host_supported_classes(vhost->host) = 0;
3498	if (rsp->service_parms.class1_parms[0] & 0x80000000)
3499		fc_host_supported_classes(vhost->host) |= FC_COS_CLASS1;
3500	if (rsp->service_parms.class2_parms[0] & 0x80000000)
3501		fc_host_supported_classes(vhost->host) |= FC_COS_CLASS2;
3502	if (rsp->service_parms.class3_parms[0] & 0x80000000)
3503		fc_host_supported_classes(vhost->host) |= FC_COS_CLASS3;
3504	fc_host_maxframe_size(vhost->host) =
3505		rsp->service_parms.common.bb_rcv_sz & 0x0fff;
3506
3507	vhost->host->can_queue = rsp->max_cmds - IBMVFC_NUM_INTERNAL_REQ;
3508	vhost->host->max_sectors = npiv_max_sectors;
3509	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY);
3510	wake_up(&vhost->work_wait_q);
3511}
3512
3513/**
3514 * ibmvfc_npiv_login - Sends NPIV login
3515 * @vhost:	ibmvfc host struct
3516 *
3517 **/
3518static void ibmvfc_npiv_login(struct ibmvfc_host *vhost)
3519{
3520	struct ibmvfc_npiv_login_mad *mad;
3521	struct ibmvfc_event *evt = ibmvfc_get_event(vhost);
3522
3523	ibmvfc_gather_partition_info(vhost);
3524	ibmvfc_set_login_info(vhost);
3525	ibmvfc_init_event(evt, ibmvfc_npiv_login_done, IBMVFC_MAD_FORMAT);
3526
3527	memcpy(vhost->login_buf, &vhost->login_info, sizeof(vhost->login_info));
3528	mad = &evt->iu.npiv_login;
3529	memset(mad, 0, sizeof(struct ibmvfc_npiv_login_mad));
3530	mad->common.version = 1;
3531	mad->common.opcode = IBMVFC_NPIV_LOGIN;
3532	mad->common.length = sizeof(struct ibmvfc_npiv_login_mad);
3533	mad->buffer.va = vhost->login_buf_dma;
3534	mad->buffer.len = sizeof(*vhost->login_buf);
3535
3536	ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT_WAIT);
3537
3538	if (!ibmvfc_send_event(evt, vhost, default_timeout))
3539		ibmvfc_dbg(vhost, "Sent NPIV login\n");
3540	else
3541		ibmvfc_link_down(vhost, IBMVFC_LINK_DEAD);
3542};
3543
3544/**
3545 * ibmvfc_dev_init_to_do - Is there target initialization work to do?
3546 * @vhost:		ibmvfc host struct
3547 *
3548 * Returns:
3549 *	1 if work to do / 0 if not
3550 **/
3551static int ibmvfc_dev_init_to_do(struct ibmvfc_host *vhost)
3552{
3553	struct ibmvfc_target *tgt;
3554
3555	list_for_each_entry(tgt, &vhost->targets, queue) {
3556		if (tgt->action == IBMVFC_TGT_ACTION_INIT ||
3557		    tgt->action == IBMVFC_TGT_ACTION_INIT_WAIT)
3558			return 1;
3559	}
3560
3561	return 0;
3562}
3563
3564/**
3565 * __ibmvfc_work_to_do - Is there task level work to do? (no locking)
3566 * @vhost:		ibmvfc host struct
3567 *
3568 * Returns:
3569 *	1 if work to do / 0 if not
3570 **/
3571static int __ibmvfc_work_to_do(struct ibmvfc_host *vhost)
3572{
3573	struct ibmvfc_target *tgt;
3574
3575	if (kthread_should_stop())
3576		return 1;
3577	switch (vhost->action) {
3578	case IBMVFC_HOST_ACTION_NONE:
3579	case IBMVFC_HOST_ACTION_INIT_WAIT:
3580		return 0;
3581	case IBMVFC_HOST_ACTION_TGT_INIT:
3582	case IBMVFC_HOST_ACTION_QUERY_TGTS:
3583		if (vhost->discovery_threads == disc_threads)
3584			return 0;
3585		list_for_each_entry(tgt, &vhost->targets, queue)
3586			if (tgt->action == IBMVFC_TGT_ACTION_INIT)
3587				return 1;
3588		list_for_each_entry(tgt, &vhost->targets, queue)
3589			if (tgt->action == IBMVFC_TGT_ACTION_INIT_WAIT)
3590				return 0;
3591		return 1;
3592	case IBMVFC_HOST_ACTION_INIT:
3593	case IBMVFC_HOST_ACTION_ALLOC_TGTS:
3594	case IBMVFC_HOST_ACTION_TGT_ADD:
3595	case IBMVFC_HOST_ACTION_TGT_DEL:
3596	case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
3597	case IBMVFC_HOST_ACTION_QUERY:
3598	default:
3599		break;
3600	};
3601
3602	return 1;
3603}
3604
3605/**
3606 * ibmvfc_work_to_do - Is there task level work to do?
3607 * @vhost:		ibmvfc host struct
3608 *
3609 * Returns:
3610 *	1 if work to do / 0 if not
3611 **/
3612static int ibmvfc_work_to_do(struct ibmvfc_host *vhost)
3613{
3614	unsigned long flags;
3615	int rc;
3616
3617	spin_lock_irqsave(vhost->host->host_lock, flags);
3618	rc = __ibmvfc_work_to_do(vhost);
3619	spin_unlock_irqrestore(vhost->host->host_lock, flags);
3620	return rc;
3621}
3622
3623/**
3624 * ibmvfc_log_ae - Log async events if necessary
3625 * @vhost:		ibmvfc host struct
3626 * @events:		events to log
3627 *
3628 **/
3629static void ibmvfc_log_ae(struct ibmvfc_host *vhost, int events)
3630{
3631	if (events & IBMVFC_AE_RSCN)
3632		fc_host_post_event(vhost->host, fc_get_event_number(), FCH_EVT_RSCN, 0);
3633	if ((events & IBMVFC_AE_LINKDOWN) &&
3634	    vhost->state >= IBMVFC_HALTED)
3635		fc_host_post_event(vhost->host, fc_get_event_number(), FCH_EVT_LINKDOWN, 0);
3636	if ((events & IBMVFC_AE_LINKUP) &&
3637	    vhost->state == IBMVFC_INITIALIZING)
3638		fc_host_post_event(vhost->host, fc_get_event_number(), FCH_EVT_LINKUP, 0);
3639}
3640
3641/**
3642 * ibmvfc_tgt_add_rport - Tell the FC transport about a new remote port
3643 * @tgt:		ibmvfc target struct
3644 *
3645 **/
3646static void ibmvfc_tgt_add_rport(struct ibmvfc_target *tgt)
3647{
3648	struct ibmvfc_host *vhost = tgt->vhost;
3649	struct fc_rport *rport = tgt->rport;
3650	unsigned long flags;
3651
3652	if (rport) {
3653		tgt_dbg(tgt, "Setting rport roles\n");
3654		fc_remote_port_rolechg(rport, tgt->ids.roles);
3655		spin_lock_irqsave(vhost->host->host_lock, flags);
3656		ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3657		spin_unlock_irqrestore(vhost->host->host_lock, flags);
3658		return;
3659	}
3660
3661	tgt_dbg(tgt, "Adding rport\n");
3662	rport = fc_remote_port_add(vhost->host, 0, &tgt->ids);
3663	spin_lock_irqsave(vhost->host->host_lock, flags);
3664	tgt->rport = rport;
3665	ibmvfc_set_tgt_action(tgt, IBMVFC_TGT_ACTION_NONE);
3666	if (rport) {
3667		tgt_dbg(tgt, "rport add succeeded\n");
3668		rport->maxframe_size = tgt->service_parms.common.bb_rcv_sz & 0x0fff;
3669		rport->supported_classes = 0;
3670		tgt->target_id = rport->scsi_target_id;
3671		if (tgt->service_parms.class1_parms[0] & 0x80000000)
3672			rport->supported_classes |= FC_COS_CLASS1;
3673		if (tgt->service_parms.class2_parms[0] & 0x80000000)
3674			rport->supported_classes |= FC_COS_CLASS2;
3675		if (tgt->service_parms.class3_parms[0] & 0x80000000)
3676			rport->supported_classes |= FC_COS_CLASS3;
3677	} else
3678		tgt_dbg(tgt, "rport add failed\n");
3679	spin_unlock_irqrestore(vhost->host->host_lock, flags);
3680}
3681
3682/**
3683 * ibmvfc_do_work - Do task level work
3684 * @vhost:		ibmvfc host struct
3685 *
3686 **/
3687static void ibmvfc_do_work(struct ibmvfc_host *vhost)
3688{
3689	struct ibmvfc_target *tgt;
3690	unsigned long flags;
3691	struct fc_rport *rport;
3692
3693	ibmvfc_log_ae(vhost, vhost->events_to_log);
3694	spin_lock_irqsave(vhost->host->host_lock, flags);
3695	vhost->events_to_log = 0;
3696	switch (vhost->action) {
3697	case IBMVFC_HOST_ACTION_NONE:
3698	case IBMVFC_HOST_ACTION_INIT_WAIT:
3699		break;
3700	case IBMVFC_HOST_ACTION_INIT:
3701		BUG_ON(vhost->state != IBMVFC_INITIALIZING);
3702		if (vhost->delay_init) {
3703			vhost->delay_init = 0;
3704			spin_unlock_irqrestore(vhost->host->host_lock, flags);
3705			ssleep(15);
3706			return;
3707		} else
3708			vhost->job_step(vhost);
3709		break;
3710	case IBMVFC_HOST_ACTION_QUERY:
3711		list_for_each_entry(tgt, &vhost->targets, queue)
3712			ibmvfc_init_tgt(tgt, ibmvfc_tgt_query_target);
3713		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY_TGTS);
3714		break;
3715	case IBMVFC_HOST_ACTION_QUERY_TGTS:
3716		list_for_each_entry(tgt, &vhost->targets, queue) {
3717			if (tgt->action == IBMVFC_TGT_ACTION_INIT) {
3718				tgt->job_step(tgt);
3719				break;
3720			}
3721		}
3722
3723		if (!ibmvfc_dev_init_to_do(vhost))
3724			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_DEL);
3725		break;
3726	case IBMVFC_HOST_ACTION_TGT_DEL:
3727	case IBMVFC_HOST_ACTION_TGT_DEL_FAILED:
3728		list_for_each_entry(tgt, &vhost->targets, queue) {
3729			if (tgt->action == IBMVFC_TGT_ACTION_DEL_RPORT) {
3730				tgt_dbg(tgt, "Deleting rport\n");
3731				rport = tgt->rport;
3732				tgt->rport = NULL;
3733				list_del(&tgt->queue);
3734				spin_unlock_irqrestore(vhost->host->host_lock, flags);
3735				if (rport)
3736					fc_remote_port_delete(rport);
3737				kref_put(&tgt->kref, ibmvfc_release_tgt);
3738				return;
3739			}
3740		}
3741
3742		if (vhost->state == IBMVFC_INITIALIZING) {
3743			if (vhost->action == IBMVFC_HOST_ACTION_TGT_DEL_FAILED) {
3744				ibmvfc_set_host_state(vhost, IBMVFC_ACTIVE);
3745				ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_ADD);
3746				vhost->init_retries = 0;
3747				spin_unlock_irqrestore(vhost->host->host_lock, flags);
3748				scsi_unblock_requests(vhost->host);
3749				return;
3750			} else {
3751				ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_INIT);
3752				vhost->job_step = ibmvfc_discover_targets;
3753			}
3754		} else {
3755			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_NONE);
3756			spin_unlock_irqrestore(vhost->host->host_lock, flags);
3757			scsi_unblock_requests(vhost->host);
3758			wake_up(&vhost->init_wait_q);
3759			return;
3760		}
3761		break;
3762	case IBMVFC_HOST_ACTION_ALLOC_TGTS:
3763		ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_INIT);
3764		spin_unlock_irqrestore(vhost->host->host_lock, flags);
3765		ibmvfc_alloc_targets(vhost);
3766		spin_lock_irqsave(vhost->host->host_lock, flags);
3767		break;
3768	case IBMVFC_HOST_ACTION_TGT_INIT:
3769		list_for_each_entry(tgt, &vhost->targets, queue) {
3770			if (tgt->action == IBMVFC_TGT_ACTION_INIT) {
3771				tgt->job_step(tgt);
3772				break;
3773			}
3774		}
3775
3776		if (!ibmvfc_dev_init_to_do(vhost))
3777			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_TGT_DEL_FAILED);
3778		break;
3779	case IBMVFC_HOST_ACTION_TGT_ADD:
3780		list_for_each_entry(tgt, &vhost->targets, queue) {
3781			if (tgt->action == IBMVFC_TGT_ACTION_ADD_RPORT) {
3782				spin_unlock_irqrestore(vhost->host->host_lock, flags);
3783				ibmvfc_tgt_add_rport(tgt);
3784				return;
3785			}
3786		}
3787
3788		if (vhost->reinit && !ibmvfc_set_host_state(vhost, IBMVFC_INITIALIZING)) {
3789			vhost->reinit = 0;
3790			scsi_block_requests(vhost->host);
3791			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_QUERY);
3792		} else {
3793			ibmvfc_set_host_action(vhost, IBMVFC_HOST_ACTION_NONE);
3794			wake_up(&vhost->init_wait_q);
3795		}
3796		break;
3797	default:
3798		break;
3799	};
3800
3801	spin_unlock_irqrestore(vhost->host->host_lock, flags);
3802}
3803
3804/**
3805 * ibmvfc_work - Do task level work
3806 * @data:		ibmvfc host struct
3807 *
3808 * Returns:
3809 *	zero
3810 **/
3811static int ibmvfc_work(void *data)
3812{
3813	struct ibmvfc_host *vhost = data;
3814	int rc;
3815
3816	set_user_nice(current, -20);
3817
3818	while (1) {
3819		rc = wait_event_interruptible(vhost->work_wait_q,
3820					      ibmvfc_work_to_do(vhost));
3821
3822		BUG_ON(rc);
3823
3824		if (kthread_should_stop())
3825			break;
3826
3827		ibmvfc_do_work(vhost);
3828	}
3829
3830	ibmvfc_dbg(vhost, "ibmvfc kthread exiting...\n");
3831	return 0;
3832}
3833
3834/**
3835 * ibmvfc_init_crq - Initializes and registers CRQ with hypervisor
3836 * @vhost:	ibmvfc host struct
3837 *
3838 * Allocates a page for messages, maps it for dma, and registers
3839 * the crq with the hypervisor.
3840 *
3841 * Return value:
3842 *	zero on success / other on failure
3843 **/
3844static int ibmvfc_init_crq(struct ibmvfc_host *vhost)
3845{
3846	int rc, retrc = -ENOMEM;
3847	struct device *dev = vhost->dev;
3848	struct vio_dev *vdev = to_vio_dev(dev);
3849	struct ibmvfc_crq_queue *crq = &vhost->crq;
3850
3851	ENTER;
3852	crq->msgs = (struct ibmvfc_crq *)get_zeroed_page(GFP_KERNEL);
3853
3854	if (!crq->msgs)
3855		return -ENOMEM;
3856
3857	crq->size = PAGE_SIZE / sizeof(*crq->msgs);
3858	crq->msg_token = dma_map_single(dev, crq->msgs,
3859					PAGE_SIZE, DMA_BIDIRECTIONAL);
3860
3861	if (dma_mapping_error(dev, crq->msg_token))
3862		goto map_failed;
3863
3864	retrc = rc = plpar_hcall_norets(H_REG_CRQ, vdev->unit_address,
3865					crq->msg_token, PAGE_SIZE);
3866
3867	if (rc == H_RESOURCE)
3868		/* maybe kexecing and resource is busy. try a reset */
3869		retrc = rc = ibmvfc_reset_crq(vhost);
3870
3871	if (rc == H_CLOSED)
3872		dev_warn(dev, "Partner adapter not ready\n");
3873	else if (rc) {
3874		dev_warn(dev, "Error %d opening adapter\n", rc);
3875		goto reg_crq_failed;
3876	}
3877
3878	retrc = 0;
3879
3880	tasklet_init(&vhost->tasklet, (void *)ibmvfc_tasklet, (unsigned long)vhost);
3881
3882	if ((rc = request_irq(vdev->irq, ibmvfc_interrupt, 0, IBMVFC_NAME, vhost))) {
3883		dev_err(dev, "Couldn't register irq 0x%x. rc=%d\n", vdev->irq, rc);
3884		goto req_irq_failed;
3885	}
3886
3887	if ((rc = vio_enable_interrupts(vdev))) {
3888		dev_err(dev, "Error %d enabling interrupts\n", rc);
3889		goto req_irq_failed;
3890	}
3891
3892	crq->cur = 0;
3893	LEAVE;
3894	return retrc;
3895
3896req_irq_failed:
3897	tasklet_kill(&vhost->tasklet);
3898	do {
3899		rc = plpar_hcall_norets(H_FREE_CRQ, vdev->unit_address);
3900	} while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
3901reg_crq_failed:
3902	dma_unmap_single(dev, crq->msg_token, PAGE_SIZE, DMA_BIDIRECTIONAL);
3903map_failed:
3904	free_page((unsigned long)crq->msgs);
3905	return retrc;
3906}
3907
3908/**
3909 * ibmvfc_free_mem - Free memory for vhost
3910 * @vhost:	ibmvfc host struct
3911 *
3912 * Return value:
3913 * 	none
3914 **/
3915static void ibmvfc_free_mem(struct ibmvfc_host *vhost)
3916{
3917	struct ibmvfc_async_crq_queue *async_q = &vhost->async_crq;
3918
3919	ENTER;
3920	mempool_destroy(vhost->tgt_pool);
3921	kfree(vhost->trace);
3922	dma_free_coherent(vhost->dev, vhost->disc_buf_sz, vhost->disc_buf,
3923			  vhost->disc_buf_dma);
3924	dma_free_coherent(vhost->dev, sizeof(*vhost->login_buf),
3925			  vhost->login_buf, vhost->login_buf_dma);
3926	dma_pool_destroy(vhost->sg_pool);
3927	dma_unmap_single(vhost->dev, async_q->msg_token,
3928			 async_q->size * sizeof(*async_q->msgs), DMA_BIDIRECTIONAL);
3929	free_page((unsigned long)async_q->msgs);
3930	LEAVE;
3931}
3932
3933/**
3934 * ibmvfc_alloc_mem - Allocate memory for vhost
3935 * @vhost:	ibmvfc host struct
3936 *
3937 * Return value:
3938 * 	0 on success / non-zero on failure
3939 **/
3940static int ibmvfc_alloc_mem(struct ibmvfc_host *vhost)
3941{
3942	struct ibmvfc_async_crq_queue *async_q = &vhost->async_crq;
3943	struct device *dev = vhost->dev;
3944
3945	ENTER;
3946	async_q->msgs = (struct ibmvfc_async_crq *)get_zeroed_page(GFP_KERNEL);
3947	if (!async_q->msgs) {
3948		dev_err(dev, "Couldn't allocate async queue.\n");
3949		goto nomem;
3950	}
3951
3952	async_q->size = PAGE_SIZE / sizeof(struct ibmvfc_async_crq);
3953	async_q->msg_token = dma_map_single(dev, async_q->msgs,
3954					    async_q->size * sizeof(*async_q->msgs),
3955					    DMA_BIDIRECTIONAL);
3956
3957	if (dma_mapping_error(dev, async_q->msg_token)) {
3958		dev_err(dev, "Failed to map async queue\n");
3959		goto free_async_crq;
3960	}
3961
3962	vhost->sg_pool = dma_pool_create(IBMVFC_NAME, dev,
3963					 SG_ALL * sizeof(struct srp_direct_buf),
3964					 sizeof(struct srp_direct_buf), 0);
3965
3966	if (!vhost->sg_pool) {
3967		dev_err(dev, "Failed to allocate sg pool\n");
3968		goto unmap_async_crq;
3969	}
3970
3971	vhost->login_buf = dma_alloc_coherent(dev, sizeof(*vhost->login_buf),
3972					      &vhost->login_buf_dma, GFP_KERNEL);
3973
3974	if (!vhost->login_buf) {
3975		dev_err(dev, "Couldn't allocate NPIV login buffer\n");
3976		goto free_sg_pool;
3977	}
3978
3979	vhost->disc_buf_sz = sizeof(vhost->disc_buf->scsi_id[0]) * max_targets;
3980	vhost->disc_buf = dma_alloc_coherent(dev, vhost->disc_buf_sz,
3981					     &vhost->disc_buf_dma, GFP_KERNEL);
3982
3983	if (!vhost->disc_buf) {
3984		dev_err(dev, "Couldn't allocate Discover Targets buffer\n");
3985		goto free_login_buffer;
3986	}
3987
3988	vhost->trace = kcalloc(IBMVFC_NUM_TRACE_ENTRIES,
3989			       sizeof(struct ibmvfc_trace_entry), GFP_KERNEL);
3990
3991	if (!vhost->trace)
3992		goto free_disc_buffer;
3993
3994	vhost->tgt_pool = mempool_create_kzalloc_pool(IBMVFC_TGT_MEMPOOL_SZ,
3995						      sizeof(struct ibmvfc_target));
3996
3997	if (!vhost->tgt_pool) {
3998		dev_err(dev, "Couldn't allocate target memory pool\n");
3999		goto free_trace;
4000	}
4001
4002	LEAVE;
4003	return 0;
4004
4005free_trace:
4006	kfree(vhost->trace);
4007free_disc_buffer:
4008	dma_free_coherent(dev, vhost->disc_buf_sz, vhost->disc_buf,
4009			  vhost->disc_buf_dma);
4010free_login_buffer:
4011	dma_free_coherent(dev, sizeof(*vhost->login_buf),
4012			  vhost->login_buf, vhost->login_buf_dma);
4013free_sg_pool:
4014	dma_pool_destroy(vhost->sg_pool);
4015unmap_async_crq:
4016	dma_unmap_single(dev, async_q->msg_token,
4017			 async_q->size * sizeof(*async_q->msgs), DMA_BIDIRECTIONAL);
4018free_async_crq:
4019	free_page((unsigned long)async_q->msgs);
4020nomem:
4021	LEAVE;
4022	return -ENOMEM;
4023}
4024
4025/**
4026 * ibmvfc_probe - Adapter hot plug add entry point
4027 * @vdev:	vio device struct
4028 * @id:	vio device id struct
4029 *
4030 * Return value:
4031 * 	0 on success / non-zero on failure
4032 **/
4033static int ibmvfc_probe(struct vio_dev *vdev, const struct vio_device_id *id)
4034{
4035	struct ibmvfc_host *vhost;
4036	struct Scsi_Host *shost;
4037	struct device *dev = &vdev->dev;
4038	int rc = -ENOMEM;
4039
4040	ENTER;
4041	shost = scsi_host_alloc(&driver_template, sizeof(*vhost));
4042	if (!shost) {
4043		dev_err(dev, "Couldn't allocate host data\n");
4044		goto out;
4045	}
4046
4047	shost->transportt = ibmvfc_transport_template;
4048	shost->can_queue = max_requests;
4049	shost->max_lun = max_lun;
4050	shost->max_id = max_targets;
4051	shost->max_sectors = IBMVFC_MAX_SECTORS;
4052	shost->max_cmd_len = IBMVFC_MAX_CDB_LEN;
4053	shost->unique_id = shost->host_no;
4054
4055	vhost = shost_priv(shost);
4056	INIT_LIST_HEAD(&vhost->sent);
4057	INIT_LIST_HEAD(&vhost->free);
4058	INIT_LIST_HEAD(&vhost->targets);
4059	sprintf(vhost->name, IBMVFC_NAME);
4060	vhost->host = shost;
4061	vhost->dev = dev;
4062	vhost->partition_number = -1;
4063	vhost->log_level = log_level;
4064	strcpy(vhost->partition_name, "UNKNOWN");
4065	init_waitqueue_head(&vhost->work_wait_q);
4066	init_waitqueue_head(&vhost->init_wait_q);
4067
4068	if ((rc = ibmvfc_alloc_mem(vhost)))
4069		goto free_scsi_host;
4070
4071	vhost->work_thread = kthread_run(ibmvfc_work, vhost, "%s_%d", IBMVFC_NAME,
4072					 shost->host_no);
4073
4074	if (IS_ERR(vhost->work_thread)) {
4075		dev_err(dev, "Couldn't create kernel thread: %ld\n",
4076			PTR_ERR(vhost->work_thread));
4077		goto free_host_mem;
4078	}
4079
4080	if ((rc = ibmvfc_init_crq(vhost))) {
4081		dev_err(dev, "Couldn't initialize crq. rc=%d\n", rc);
4082		goto kill_kthread;
4083	}
4084
4085	if ((rc = ibmvfc_init_event_pool(vhost))) {
4086		dev_err(dev, "Couldn't initialize event pool. rc=%d\n", rc);
4087		goto release_crq;
4088	}
4089
4090	if ((rc = scsi_add_host(shost, dev)))
4091		goto release_event_pool;
4092
4093	if ((rc = ibmvfc_create_trace_file(&shost->shost_dev.kobj,
4094					   &ibmvfc_trace_attr))) {
4095		dev_err(dev, "Failed to create trace file. rc=%d\n", rc);
4096		goto remove_shost;
4097	}
4098
4099	dev_set_drvdata(dev, vhost);
4100	spin_lock(&ibmvfc_driver_lock);
4101	list_add_tail(&vhost->queue, &ibmvfc_head);
4102	spin_unlock(&ibmvfc_driver_lock);
4103
4104	ibmvfc_send_crq_init(vhost);
4105	scsi_scan_host(shost);
4106	return 0;
4107
4108remove_shost:
4109	scsi_remove_host(shost);
4110release_event_pool:
4111	ibmvfc_free_event_pool(vhost);
4112release_crq:
4113	ibmvfc_release_crq_queue(vhost);
4114kill_kthread:
4115	kthread_stop(vhost->work_thread);
4116free_host_mem:
4117	ibmvfc_free_mem(vhost);
4118free_scsi_host:
4119	scsi_host_put(shost);
4120out:
4121	LEAVE;
4122	return rc;
4123}
4124
4125/**
4126 * ibmvfc_remove - Adapter hot plug remove entry point
4127 * @vdev:	vio device struct
4128 *
4129 * Return value:
4130 * 	0
4131 **/
4132static int ibmvfc_remove(struct vio_dev *vdev)
4133{
4134	struct ibmvfc_host *vhost = dev_get_drvdata(&vdev->dev);
4135	unsigned long flags;
4136
4137	ENTER;
4138	ibmvfc_remove_trace_file(&vhost->host->shost_dev.kobj, &ibmvfc_trace_attr);
4139	ibmvfc_link_down(vhost, IBMVFC_HOST_OFFLINE);
4140	ibmvfc_wait_while_resetting(vhost);
4141	ibmvfc_release_crq_queue(vhost);
4142	kthread_stop(vhost->work_thread);
4143	fc_remove_host(vhost->host);
4144	scsi_remove_host(vhost->host);
4145
4146	spin_lock_irqsave(vhost->host->host_lock, flags);
4147	ibmvfc_purge_requests(vhost, DID_ERROR);
4148	ibmvfc_free_event_pool(vhost);
4149	spin_unlock_irqrestore(vhost->host->host_lock, flags);
4150
4151	ibmvfc_free_mem(vhost);
4152	spin_lock(&ibmvfc_driver_lock);
4153	list_del(&vhost->queue);
4154	spin_unlock(&ibmvfc_driver_lock);
4155	scsi_host_put(vhost->host);
4156	LEAVE;
4157	return 0;
4158}
4159
4160/**
4161 * ibmvfc_get_desired_dma - Calculate DMA resources needed by the driver
4162 * @vdev:	vio device struct
4163 *
4164 * Return value:
4165 *	Number of bytes the driver will need to DMA map at the same time in
4166 *	order to perform well.
4167 */
4168static unsigned long ibmvfc_get_desired_dma(struct vio_dev *vdev)
4169{
4170	unsigned long pool_dma = max_requests * sizeof(union ibmvfc_iu);
4171	return pool_dma + ((512 * 1024) * driver_template.cmd_per_lun);
4172}
4173
4174static struct vio_device_id ibmvfc_device_table[] __devinitdata = {
4175	{"fcp", "IBM,vfc-client"},
4176	{ "", "" }
4177};
4178MODULE_DEVICE_TABLE(vio, ibmvfc_device_table);
4179
4180static struct vio_driver ibmvfc_driver = {
4181	.id_table = ibmvfc_device_table,
4182	.probe = ibmvfc_probe,
4183	.remove = ibmvfc_remove,
4184	.get_desired_dma = ibmvfc_get_desired_dma,
4185	.driver = {
4186		.name = IBMVFC_NAME,
4187		.owner = THIS_MODULE,
4188	}
4189};
4190
4191static struct fc_function_template ibmvfc_transport_functions = {
4192	.show_host_fabric_name = 1,
4193	.show_host_node_name = 1,
4194	.show_host_port_name = 1,
4195	.show_host_supported_classes = 1,
4196	.show_host_port_type = 1,
4197	.show_host_port_id = 1,
4198
4199	.get_host_port_state = ibmvfc_get_host_port_state,
4200	.show_host_port_state = 1,
4201
4202	.get_host_speed = ibmvfc_get_host_speed,
4203	.show_host_speed = 1,
4204
4205	.issue_fc_host_lip = ibmvfc_issue_fc_host_lip,
4206	.terminate_rport_io = ibmvfc_terminate_rport_io,
4207
4208	.show_rport_maxframe_size = 1,
4209	.show_rport_supported_classes = 1,
4210
4211	.set_rport_dev_loss_tmo = ibmvfc_set_rport_dev_loss_tmo,
4212	.show_rport_dev_loss_tmo = 1,
4213
4214	.get_starget_node_name = ibmvfc_get_starget_node_name,
4215	.show_starget_node_name = 1,
4216
4217	.get_starget_port_name = ibmvfc_get_starget_port_name,
4218	.show_starget_port_name = 1,
4219
4220	.get_starget_port_id = ibmvfc_get_starget_port_id,
4221	.show_starget_port_id = 1,
4222};
4223
4224/**
4225 * ibmvfc_module_init - Initialize the ibmvfc module
4226 *
4227 * Return value:
4228 * 	0 on success / other on failure
4229 **/
4230static int __init ibmvfc_module_init(void)
4231{
4232	int rc;
4233
4234	if (!firmware_has_feature(FW_FEATURE_VIO))
4235		return -ENODEV;
4236
4237	printk(KERN_INFO IBMVFC_NAME": IBM Virtual Fibre Channel Driver version: %s %s\n",
4238	       IBMVFC_DRIVER_VERSION, IBMVFC_DRIVER_DATE);
4239
4240	ibmvfc_transport_template = fc_attach_transport(&ibmvfc_transport_functions);
4241	if (!ibmvfc_transport_template)
4242		return -ENOMEM;
4243
4244	rc = vio_register_driver(&ibmvfc_driver);
4245	if (rc)
4246		fc_release_transport(ibmvfc_transport_template);
4247	return rc;
4248}
4249
4250/**
4251 * ibmvfc_module_exit - Teardown the ibmvfc module
4252 *
4253 * Return value:
4254 * 	nothing
4255 **/
4256static void __exit ibmvfc_module_exit(void)
4257{
4258	vio_unregister_driver(&ibmvfc_driver);
4259	fc_release_transport(ibmvfc_transport_template);
4260}
4261
4262module_init(ibmvfc_module_init);
4263module_exit(ibmvfc_module_exit);
4264