1 /*******************************************************************************
2  * This file contains tcm implementation using v4 configfs fabric infrastructure
3  * for QLogic target mode HBAs
4  *
5  * (c) Copyright 2010-2013 Datera, Inc.
6  *
7  * Author: Nicholas A. Bellinger <nab@daterainc.com>
8  *
9  * tcm_qla2xxx_parse_wwn() and tcm_qla2xxx_format_wwn() contains code from
10  * the TCM_FC / Open-FCoE.org fabric module.
11  *
12  * Copyright (c) 2010 Cisco Systems, Inc
13  *
14  * This program is free software; you can redistribute it and/or modify
15  * it under the terms of the GNU General Public License as published by
16  * the Free Software Foundation; either version 2 of the License, or
17  * (at your option) any later version.
18  *
19  * This program is distributed in the hope that it will be useful,
20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
22  * GNU General Public License for more details.
23  ****************************************************************************/
24 
25 
26 #include <linux/module.h>
27 #include <linux/moduleparam.h>
28 #include <generated/utsrelease.h>
29 #include <linux/utsname.h>
30 #include <linux/vmalloc.h>
31 #include <linux/init.h>
32 #include <linux/list.h>
33 #include <linux/slab.h>
34 #include <linux/kthread.h>
35 #include <linux/types.h>
36 #include <linux/string.h>
37 #include <linux/configfs.h>
38 #include <linux/ctype.h>
39 #include <asm/unaligned.h>
40 #include <scsi/scsi.h>
41 #include <scsi/scsi_host.h>
42 #include <scsi/scsi_device.h>
43 #include <scsi/scsi_cmnd.h>
44 #include <target/target_core_base.h>
45 #include <target/target_core_fabric.h>
46 
47 #include "qla_def.h"
48 #include "qla_target.h"
49 #include "tcm_qla2xxx.h"
50 
51 static struct workqueue_struct *tcm_qla2xxx_free_wq;
52 static struct workqueue_struct *tcm_qla2xxx_cmd_wq;
53 
54 /*
55  * Parse WWN.
56  * If strict, we require lower-case hex and colon separators to be sure
57  * the name is the same as what would be generated by ft_format_wwn()
58  * so the name and wwn are mapped one-to-one.
59  */
60 static ssize_t tcm_qla2xxx_parse_wwn(const char *name, u64 *wwn, int strict)
61 {
62 	const char *cp;
63 	char c;
64 	u32 nibble;
65 	u32 byte = 0;
66 	u32 pos = 0;
67 	u32 err;
68 
69 	*wwn = 0;
70 	for (cp = name; cp < &name[TCM_QLA2XXX_NAMELEN - 1]; cp++) {
71 		c = *cp;
72 		if (c == '\n' && cp[1] == '\0')
73 			continue;
74 		if (strict && pos++ == 2 && byte++ < 7) {
75 			pos = 0;
76 			if (c == ':')
77 				continue;
78 			err = 1;
79 			goto fail;
80 		}
81 		if (c == '\0') {
82 			err = 2;
83 			if (strict && byte != 8)
84 				goto fail;
85 			return cp - name;
86 		}
87 		err = 3;
88 		if (isdigit(c))
89 			nibble = c - '0';
90 		else if (isxdigit(c) && (islower(c) || !strict))
91 			nibble = tolower(c) - 'a' + 10;
92 		else
93 			goto fail;
94 		*wwn = (*wwn << 4) | nibble;
95 	}
96 	err = 4;
97 fail:
98 	pr_debug("err %u len %zu pos %u byte %u\n",
99 			err, cp - name, pos, byte);
100 	return -1;
101 }
102 
103 static ssize_t tcm_qla2xxx_format_wwn(char *buf, size_t len, u64 wwn)
104 {
105 	u8 b[8];
106 
107 	put_unaligned_be64(wwn, b);
108 	return snprintf(buf, len,
109 		"%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x",
110 		b[0], b[1], b[2], b[3], b[4], b[5], b[6], b[7]);
111 }
112 
113 static char *tcm_qla2xxx_get_fabric_name(void)
114 {
115 	return "qla2xxx";
116 }
117 
118 /*
119  * From drivers/scsi/scsi_transport_fc.c:fc_parse_wwn
120  */
121 static int tcm_qla2xxx_npiv_extract_wwn(const char *ns, u64 *nm)
122 {
123 	unsigned int i, j;
124 	u8 wwn[8];
125 
126 	memset(wwn, 0, sizeof(wwn));
127 
128 	/* Validate and store the new name */
129 	for (i = 0, j = 0; i < 16; i++) {
130 		int value;
131 
132 		value = hex_to_bin(*ns++);
133 		if (value >= 0)
134 			j = (j << 4) | value;
135 		else
136 			return -EINVAL;
137 
138 		if (i % 2) {
139 			wwn[i/2] = j & 0xff;
140 			j = 0;
141 		}
142 	}
143 
144 	*nm = wwn_to_u64(wwn);
145 	return 0;
146 }
147 
148 /*
149  * This parsing logic follows drivers/scsi/scsi_transport_fc.c:
150  * store_fc_host_vport_create()
151  */
152 static int tcm_qla2xxx_npiv_parse_wwn(
153 	const char *name,
154 	size_t count,
155 	u64 *wwpn,
156 	u64 *wwnn)
157 {
158 	unsigned int cnt = count;
159 	int rc;
160 
161 	*wwpn = 0;
162 	*wwnn = 0;
163 
164 	/* count may include a LF at end of string */
165 	if (name[cnt-1] == '\n' || name[cnt-1] == 0)
166 		cnt--;
167 
168 	/* validate we have enough characters for WWPN */
169 	if ((cnt != (16+1+16)) || (name[16] != ':'))
170 		return -EINVAL;
171 
172 	rc = tcm_qla2xxx_npiv_extract_wwn(&name[0], wwpn);
173 	if (rc != 0)
174 		return rc;
175 
176 	rc = tcm_qla2xxx_npiv_extract_wwn(&name[17], wwnn);
177 	if (rc != 0)
178 		return rc;
179 
180 	return 0;
181 }
182 
183 static char *tcm_qla2xxx_npiv_get_fabric_name(void)
184 {
185 	return "qla2xxx_npiv";
186 }
187 
188 static char *tcm_qla2xxx_get_fabric_wwn(struct se_portal_group *se_tpg)
189 {
190 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
191 				struct tcm_qla2xxx_tpg, se_tpg);
192 	struct tcm_qla2xxx_lport *lport = tpg->lport;
193 
194 	return lport->lport_naa_name;
195 }
196 
197 static u16 tcm_qla2xxx_get_tag(struct se_portal_group *se_tpg)
198 {
199 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
200 				struct tcm_qla2xxx_tpg, se_tpg);
201 	return tpg->lport_tpgt;
202 }
203 
204 static int tcm_qla2xxx_check_demo_mode(struct se_portal_group *se_tpg)
205 {
206 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
207 				struct tcm_qla2xxx_tpg, se_tpg);
208 
209 	return tpg->tpg_attrib.generate_node_acls;
210 }
211 
212 static int tcm_qla2xxx_check_demo_mode_cache(struct se_portal_group *se_tpg)
213 {
214 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
215 				struct tcm_qla2xxx_tpg, se_tpg);
216 
217 	return tpg->tpg_attrib.cache_dynamic_acls;
218 }
219 
220 static int tcm_qla2xxx_check_demo_write_protect(struct se_portal_group *se_tpg)
221 {
222 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
223 				struct tcm_qla2xxx_tpg, se_tpg);
224 
225 	return tpg->tpg_attrib.demo_mode_write_protect;
226 }
227 
228 static int tcm_qla2xxx_check_prod_write_protect(struct se_portal_group *se_tpg)
229 {
230 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
231 				struct tcm_qla2xxx_tpg, se_tpg);
232 
233 	return tpg->tpg_attrib.prod_mode_write_protect;
234 }
235 
236 static int tcm_qla2xxx_check_demo_mode_login_only(struct se_portal_group *se_tpg)
237 {
238 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
239 				struct tcm_qla2xxx_tpg, se_tpg);
240 
241 	return tpg->tpg_attrib.demo_mode_login_only;
242 }
243 
244 static int tcm_qla2xxx_check_prot_fabric_only(struct se_portal_group *se_tpg)
245 {
246 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
247 				struct tcm_qla2xxx_tpg, se_tpg);
248 
249 	return tpg->tpg_attrib.fabric_prot_type;
250 }
251 
252 static u32 tcm_qla2xxx_tpg_get_inst_index(struct se_portal_group *se_tpg)
253 {
254 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
255 				struct tcm_qla2xxx_tpg, se_tpg);
256 
257 	return tpg->lport_tpgt;
258 }
259 
260 static void tcm_qla2xxx_complete_mcmd(struct work_struct *work)
261 {
262 	struct qla_tgt_mgmt_cmd *mcmd = container_of(work,
263 			struct qla_tgt_mgmt_cmd, free_work);
264 
265 	transport_generic_free_cmd(&mcmd->se_cmd, 0);
266 }
267 
268 /*
269  * Called from qla_target_template->free_mcmd(), and will call
270  * tcm_qla2xxx_release_cmd() via normal struct target_core_fabric_ops
271  * release callback.  qla_hw_data->hardware_lock is expected to be held
272  */
273 static void tcm_qla2xxx_free_mcmd(struct qla_tgt_mgmt_cmd *mcmd)
274 {
275 	INIT_WORK(&mcmd->free_work, tcm_qla2xxx_complete_mcmd);
276 	queue_work(tcm_qla2xxx_free_wq, &mcmd->free_work);
277 }
278 
279 static void tcm_qla2xxx_complete_free(struct work_struct *work)
280 {
281 	struct qla_tgt_cmd *cmd = container_of(work, struct qla_tgt_cmd, work);
282 
283 	cmd->cmd_in_wq = 0;
284 
285 	WARN_ON(cmd->cmd_flags &  BIT_16);
286 
287 	cmd->vha->tgt_counters.qla_core_ret_sta_ctio++;
288 	cmd->cmd_flags |= BIT_16;
289 	transport_generic_free_cmd(&cmd->se_cmd, 0);
290 }
291 
292 /*
293  * Called from qla_target_template->free_cmd(), and will call
294  * tcm_qla2xxx_release_cmd via normal struct target_core_fabric_ops
295  * release callback.  qla_hw_data->hardware_lock is expected to be held
296  */
297 static void tcm_qla2xxx_free_cmd(struct qla_tgt_cmd *cmd)
298 {
299 	cmd->vha->tgt_counters.core_qla_free_cmd++;
300 	cmd->cmd_in_wq = 1;
301 
302 	BUG_ON(cmd->cmd_flags & BIT_20);
303 	cmd->cmd_flags |= BIT_20;
304 
305 	INIT_WORK(&cmd->work, tcm_qla2xxx_complete_free);
306 	queue_work_on(smp_processor_id(), tcm_qla2xxx_free_wq, &cmd->work);
307 }
308 
309 /*
310  * Called from struct target_core_fabric_ops->check_stop_free() context
311  */
312 static int tcm_qla2xxx_check_stop_free(struct se_cmd *se_cmd)
313 {
314 	struct qla_tgt_cmd *cmd;
315 
316 	if ((se_cmd->se_cmd_flags & SCF_SCSI_TMR_CDB) == 0) {
317 		cmd = container_of(se_cmd, struct qla_tgt_cmd, se_cmd);
318 		cmd->cmd_flags |= BIT_14;
319 	}
320 
321 	return target_put_sess_cmd(se_cmd);
322 }
323 
324 /* tcm_qla2xxx_release_cmd - Callback from TCM Core to release underlying
325  * fabric descriptor @se_cmd command to release
326  */
327 static void tcm_qla2xxx_release_cmd(struct se_cmd *se_cmd)
328 {
329 	struct qla_tgt_cmd *cmd;
330 
331 	if (se_cmd->se_cmd_flags & SCF_SCSI_TMR_CDB) {
332 		struct qla_tgt_mgmt_cmd *mcmd = container_of(se_cmd,
333 				struct qla_tgt_mgmt_cmd, se_cmd);
334 		qlt_free_mcmd(mcmd);
335 		return;
336 	}
337 
338 	cmd = container_of(se_cmd, struct qla_tgt_cmd, se_cmd);
339 	qlt_free_cmd(cmd);
340 }
341 
342 static void tcm_qla2xxx_close_session(struct se_session *se_sess)
343 {
344 	struct qla_tgt_sess *sess = se_sess->fabric_sess_ptr;
345 	struct scsi_qla_host *vha;
346 	unsigned long flags;
347 
348 	BUG_ON(!sess);
349 	vha = sess->vha;
350 
351 	spin_lock_irqsave(&vha->hw->tgt.sess_lock, flags);
352 	target_sess_cmd_list_set_waiting(se_sess);
353 	qlt_put_sess(sess);
354 	spin_unlock_irqrestore(&vha->hw->tgt.sess_lock, flags);
355 }
356 
357 static u32 tcm_qla2xxx_sess_get_index(struct se_session *se_sess)
358 {
359 	return 0;
360 }
361 
362 static int tcm_qla2xxx_write_pending(struct se_cmd *se_cmd)
363 {
364 	struct qla_tgt_cmd *cmd = container_of(se_cmd,
365 				struct qla_tgt_cmd, se_cmd);
366 
367 	if (cmd->aborted) {
368 		/* Cmd can loop during Q-full.  tcm_qla2xxx_aborted_task
369 		 * can get ahead of this cmd. tcm_qla2xxx_aborted_task
370 		 * already kick start the free.
371 		 */
372 		pr_debug("write_pending aborted cmd[%p] refcount %d "
373 			"transport_state %x, t_state %x, se_cmd_flags %x\n",
374 			cmd,cmd->se_cmd.cmd_kref.refcount.counter,
375 			cmd->se_cmd.transport_state,
376 			cmd->se_cmd.t_state,
377 			cmd->se_cmd.se_cmd_flags);
378 		return 0;
379 	}
380 	cmd->cmd_flags |= BIT_3;
381 	cmd->bufflen = se_cmd->data_length;
382 	cmd->dma_data_direction = target_reverse_dma_direction(se_cmd);
383 
384 	cmd->sg_cnt = se_cmd->t_data_nents;
385 	cmd->sg = se_cmd->t_data_sg;
386 
387 	cmd->prot_sg_cnt = se_cmd->t_prot_nents;
388 	cmd->prot_sg = se_cmd->t_prot_sg;
389 	cmd->blk_sz  = se_cmd->se_dev->dev_attrib.block_size;
390 	se_cmd->pi_err = 0;
391 
392 	/*
393 	 * qla_target.c:qlt_rdy_to_xfer() will call pci_map_sg() to setup
394 	 * the SGL mappings into PCIe memory for incoming FCP WRITE data.
395 	 */
396 	return qlt_rdy_to_xfer(cmd);
397 }
398 
399 static int tcm_qla2xxx_write_pending_status(struct se_cmd *se_cmd)
400 {
401 	unsigned long flags;
402 	/*
403 	 * Check for WRITE_PENDING status to determine if we need to wait for
404 	 * CTIO aborts to be posted via hardware in tcm_qla2xxx_handle_data().
405 	 */
406 	spin_lock_irqsave(&se_cmd->t_state_lock, flags);
407 	if (se_cmd->t_state == TRANSPORT_WRITE_PENDING ||
408 	    se_cmd->t_state == TRANSPORT_COMPLETE_QF_WP) {
409 		spin_unlock_irqrestore(&se_cmd->t_state_lock, flags);
410 		wait_for_completion_timeout(&se_cmd->t_transport_stop_comp,
411 						50);
412 		return 0;
413 	}
414 	spin_unlock_irqrestore(&se_cmd->t_state_lock, flags);
415 
416 	return 0;
417 }
418 
419 static void tcm_qla2xxx_set_default_node_attrs(struct se_node_acl *nacl)
420 {
421 	return;
422 }
423 
424 static int tcm_qla2xxx_get_cmd_state(struct se_cmd *se_cmd)
425 {
426 	if (!(se_cmd->se_cmd_flags & SCF_SCSI_TMR_CDB)) {
427 		struct qla_tgt_cmd *cmd = container_of(se_cmd,
428 				struct qla_tgt_cmd, se_cmd);
429 		return cmd->state;
430 	}
431 
432 	return 0;
433 }
434 
435 /*
436  * Called from process context in qla_target.c:qlt_do_work() code
437  */
438 static int tcm_qla2xxx_handle_cmd(scsi_qla_host_t *vha, struct qla_tgt_cmd *cmd,
439 	unsigned char *cdb, uint32_t data_length, int fcp_task_attr,
440 	int data_dir, int bidi)
441 {
442 	struct se_cmd *se_cmd = &cmd->se_cmd;
443 	struct se_session *se_sess;
444 	struct qla_tgt_sess *sess;
445 #ifdef CONFIG_TCM_QLA2XXX_DEBUG
446 	struct se_portal_group *se_tpg;
447 	struct tcm_qla2xxx_tpg *tpg;
448 #endif
449 	int flags = TARGET_SCF_ACK_KREF;
450 
451 	if (bidi)
452 		flags |= TARGET_SCF_BIDI_OP;
453 
454 	if (se_cmd->cpuid != WORK_CPU_UNBOUND)
455 		flags |= TARGET_SCF_USE_CPUID;
456 
457 	sess = cmd->sess;
458 	if (!sess) {
459 		pr_err("Unable to locate struct qla_tgt_sess from qla_tgt_cmd\n");
460 		return -EINVAL;
461 	}
462 
463 	se_sess = sess->se_sess;
464 	if (!se_sess) {
465 		pr_err("Unable to locate active struct se_session\n");
466 		return -EINVAL;
467 	}
468 
469 #ifdef CONFIG_TCM_QLA2XXX_DEBUG
470 	se_tpg = se_sess->se_tpg;
471 	tpg = container_of(se_tpg, struct tcm_qla2xxx_tpg, se_tpg);
472 	if (unlikely(tpg->tpg_attrib.jam_host)) {
473 		/* return, and dont run target_submit_cmd,discarding command */
474 		return 0;
475 	}
476 #endif
477 
478 	cmd->vha->tgt_counters.qla_core_sbt_cmd++;
479 	return target_submit_cmd(se_cmd, se_sess, cdb, &cmd->sense_buffer[0],
480 				cmd->unpacked_lun, data_length, fcp_task_attr,
481 				data_dir, flags);
482 }
483 
484 static void tcm_qla2xxx_handle_data_work(struct work_struct *work)
485 {
486 	struct qla_tgt_cmd *cmd = container_of(work, struct qla_tgt_cmd, work);
487 	unsigned long flags;
488 
489 	/*
490 	 * Ensure that the complete FCP WRITE payload has been received.
491 	 * Otherwise return an exception via CHECK_CONDITION status.
492 	 */
493 	cmd->cmd_in_wq = 0;
494 
495 	spin_lock_irqsave(&cmd->cmd_lock, flags);
496 	cmd->cmd_flags |= CMD_FLAG_DATA_WORK;
497 	if (cmd->aborted) {
498 		cmd->cmd_flags |= CMD_FLAG_DATA_WORK_FREE;
499 		spin_unlock_irqrestore(&cmd->cmd_lock, flags);
500 
501 		tcm_qla2xxx_free_cmd(cmd);
502 		return;
503 	}
504 	spin_unlock_irqrestore(&cmd->cmd_lock, flags);
505 
506 	cmd->vha->tgt_counters.qla_core_ret_ctio++;
507 	if (!cmd->write_data_transferred) {
508 		/*
509 		 * Check if se_cmd has already been aborted via LUN_RESET, and
510 		 * waiting upon completion in tcm_qla2xxx_write_pending_status()
511 		 */
512 		if (cmd->se_cmd.transport_state & CMD_T_ABORTED) {
513 			complete(&cmd->se_cmd.t_transport_stop_comp);
514 			return;
515 		}
516 
517 		if (cmd->se_cmd.pi_err)
518 			transport_generic_request_failure(&cmd->se_cmd,
519 				cmd->se_cmd.pi_err);
520 		else
521 			transport_generic_request_failure(&cmd->se_cmd,
522 				TCM_CHECK_CONDITION_ABORT_CMD);
523 
524 		return;
525 	}
526 
527 	return target_execute_cmd(&cmd->se_cmd);
528 }
529 
530 /*
531  * Called from qla_target.c:qlt_do_ctio_completion()
532  */
533 static void tcm_qla2xxx_handle_data(struct qla_tgt_cmd *cmd)
534 {
535 	cmd->cmd_flags |= BIT_10;
536 	cmd->cmd_in_wq = 1;
537 	INIT_WORK(&cmd->work, tcm_qla2xxx_handle_data_work);
538 	queue_work_on(smp_processor_id(), tcm_qla2xxx_free_wq, &cmd->work);
539 }
540 
541 static void tcm_qla2xxx_handle_dif_work(struct work_struct *work)
542 {
543 	struct qla_tgt_cmd *cmd = container_of(work, struct qla_tgt_cmd, work);
544 
545 	/* take an extra kref to prevent cmd free too early.
546 	 * need to wait for SCSI status/check condition to
547 	 * finish responding generate by transport_generic_request_failure.
548 	 */
549 	kref_get(&cmd->se_cmd.cmd_kref);
550 	transport_generic_request_failure(&cmd->se_cmd, cmd->se_cmd.pi_err);
551 }
552 
553 /*
554  * Called from qla_target.c:qlt_do_ctio_completion()
555  */
556 static void tcm_qla2xxx_handle_dif_err(struct qla_tgt_cmd *cmd)
557 {
558 	INIT_WORK(&cmd->work, tcm_qla2xxx_handle_dif_work);
559 	queue_work(tcm_qla2xxx_free_wq, &cmd->work);
560 }
561 
562 /*
563  * Called from qla_target.c:qlt_issue_task_mgmt()
564  */
565 static int tcm_qla2xxx_handle_tmr(struct qla_tgt_mgmt_cmd *mcmd, uint32_t lun,
566 	uint8_t tmr_func, uint32_t tag)
567 {
568 	struct qla_tgt_sess *sess = mcmd->sess;
569 	struct se_cmd *se_cmd = &mcmd->se_cmd;
570 
571 	return target_submit_tmr(se_cmd, sess->se_sess, NULL, lun, mcmd,
572 			tmr_func, GFP_ATOMIC, tag, TARGET_SCF_ACK_KREF);
573 }
574 
575 static int tcm_qla2xxx_queue_data_in(struct se_cmd *se_cmd)
576 {
577 	struct qla_tgt_cmd *cmd = container_of(se_cmd,
578 				struct qla_tgt_cmd, se_cmd);
579 
580 	if (cmd->aborted) {
581 		/* Cmd can loop during Q-full.  tcm_qla2xxx_aborted_task
582 		 * can get ahead of this cmd. tcm_qla2xxx_aborted_task
583 		 * already kick start the free.
584 		 */
585 		pr_debug("queue_data_in aborted cmd[%p] refcount %d "
586 			"transport_state %x, t_state %x, se_cmd_flags %x\n",
587 			cmd,cmd->se_cmd.cmd_kref.refcount.counter,
588 			cmd->se_cmd.transport_state,
589 			cmd->se_cmd.t_state,
590 			cmd->se_cmd.se_cmd_flags);
591 		return 0;
592 	}
593 
594 	cmd->cmd_flags |= BIT_4;
595 	cmd->bufflen = se_cmd->data_length;
596 	cmd->dma_data_direction = target_reverse_dma_direction(se_cmd);
597 
598 	cmd->sg_cnt = se_cmd->t_data_nents;
599 	cmd->sg = se_cmd->t_data_sg;
600 	cmd->offset = 0;
601 
602 	cmd->prot_sg_cnt = se_cmd->t_prot_nents;
603 	cmd->prot_sg = se_cmd->t_prot_sg;
604 	cmd->blk_sz  = se_cmd->se_dev->dev_attrib.block_size;
605 	se_cmd->pi_err = 0;
606 
607 	/*
608 	 * Now queue completed DATA_IN the qla2xxx LLD and response ring
609 	 */
610 	return qlt_xmit_response(cmd, QLA_TGT_XMIT_DATA|QLA_TGT_XMIT_STATUS,
611 				se_cmd->scsi_status);
612 }
613 
614 static int tcm_qla2xxx_queue_status(struct se_cmd *se_cmd)
615 {
616 	struct qla_tgt_cmd *cmd = container_of(se_cmd,
617 				struct qla_tgt_cmd, se_cmd);
618 	int xmit_type = QLA_TGT_XMIT_STATUS;
619 
620 	cmd->bufflen = se_cmd->data_length;
621 	cmd->sg = NULL;
622 	cmd->sg_cnt = 0;
623 	cmd->offset = 0;
624 	cmd->dma_data_direction = target_reverse_dma_direction(se_cmd);
625 	if (cmd->cmd_flags &  BIT_5) {
626 		pr_crit("Bit_5 already set for cmd = %p.\n", cmd);
627 		dump_stack();
628 	}
629 	cmd->cmd_flags |= BIT_5;
630 
631 	if (se_cmd->data_direction == DMA_FROM_DEVICE) {
632 		/*
633 		 * For FCP_READ with CHECK_CONDITION status, clear cmd->bufflen
634 		 * for qla_tgt_xmit_response LLD code
635 		 */
636 		if (se_cmd->se_cmd_flags & SCF_OVERFLOW_BIT) {
637 			se_cmd->se_cmd_flags &= ~SCF_OVERFLOW_BIT;
638 			se_cmd->residual_count = 0;
639 		}
640 		se_cmd->se_cmd_flags |= SCF_UNDERFLOW_BIT;
641 		se_cmd->residual_count += se_cmd->data_length;
642 
643 		cmd->bufflen = 0;
644 	}
645 	/*
646 	 * Now queue status response to qla2xxx LLD code and response ring
647 	 */
648 	return qlt_xmit_response(cmd, xmit_type, se_cmd->scsi_status);
649 }
650 
651 static void tcm_qla2xxx_queue_tm_rsp(struct se_cmd *se_cmd)
652 {
653 	struct se_tmr_req *se_tmr = se_cmd->se_tmr_req;
654 	struct qla_tgt_mgmt_cmd *mcmd = container_of(se_cmd,
655 				struct qla_tgt_mgmt_cmd, se_cmd);
656 
657 	pr_debug("queue_tm_rsp: mcmd: %p func: 0x%02x response: 0x%02x\n",
658 			mcmd, se_tmr->function, se_tmr->response);
659 	/*
660 	 * Do translation between TCM TM response codes and
661 	 * QLA2xxx FC TM response codes.
662 	 */
663 	switch (se_tmr->response) {
664 	case TMR_FUNCTION_COMPLETE:
665 		mcmd->fc_tm_rsp = FC_TM_SUCCESS;
666 		break;
667 	case TMR_TASK_DOES_NOT_EXIST:
668 		mcmd->fc_tm_rsp = FC_TM_BAD_CMD;
669 		break;
670 	case TMR_FUNCTION_REJECTED:
671 		mcmd->fc_tm_rsp = FC_TM_REJECT;
672 		break;
673 	case TMR_LUN_DOES_NOT_EXIST:
674 	default:
675 		mcmd->fc_tm_rsp = FC_TM_FAILED;
676 		break;
677 	}
678 	/*
679 	 * Queue the TM response to QLA2xxx LLD to build a
680 	 * CTIO response packet.
681 	 */
682 	qlt_xmit_tm_rsp(mcmd);
683 }
684 
685 
686 #define DATA_WORK_NOT_FREE(_flags) \
687 	(( _flags & (CMD_FLAG_DATA_WORK|CMD_FLAG_DATA_WORK_FREE)) == \
688 	 CMD_FLAG_DATA_WORK)
689 static void tcm_qla2xxx_aborted_task(struct se_cmd *se_cmd)
690 {
691 	struct qla_tgt_cmd *cmd = container_of(se_cmd,
692 				struct qla_tgt_cmd, se_cmd);
693 	unsigned long flags;
694 
695 	if (qlt_abort_cmd(cmd))
696 		return;
697 
698 	spin_lock_irqsave(&cmd->cmd_lock, flags);
699 	if ((cmd->state == QLA_TGT_STATE_NEW)||
700 		((cmd->state == QLA_TGT_STATE_DATA_IN) &&
701 		 DATA_WORK_NOT_FREE(cmd->cmd_flags)) ) {
702 
703 		cmd->cmd_flags |= CMD_FLAG_DATA_WORK_FREE;
704 		spin_unlock_irqrestore(&cmd->cmd_lock, flags);
705 		/* Cmd have not reached firmware.
706 		 * Use this trigger to free it. */
707 		tcm_qla2xxx_free_cmd(cmd);
708 		return;
709 	}
710 	spin_unlock_irqrestore(&cmd->cmd_lock, flags);
711 	return;
712 
713 }
714 
715 static void tcm_qla2xxx_clear_sess_lookup(struct tcm_qla2xxx_lport *,
716 			struct tcm_qla2xxx_nacl *, struct qla_tgt_sess *);
717 /*
718  * Expected to be called with struct qla_hw_data->tgt.sess_lock held
719  */
720 static void tcm_qla2xxx_clear_nacl_from_fcport_map(struct qla_tgt_sess *sess)
721 {
722 	struct se_node_acl *se_nacl = sess->se_sess->se_node_acl;
723 	struct se_portal_group *se_tpg = se_nacl->se_tpg;
724 	struct se_wwn *se_wwn = se_tpg->se_tpg_wwn;
725 	struct tcm_qla2xxx_lport *lport = container_of(se_wwn,
726 				struct tcm_qla2xxx_lport, lport_wwn);
727 	struct tcm_qla2xxx_nacl *nacl = container_of(se_nacl,
728 				struct tcm_qla2xxx_nacl, se_node_acl);
729 	void *node;
730 
731 	pr_debug("fc_rport domain: port_id 0x%06x\n", nacl->nport_id);
732 
733 	node = btree_remove32(&lport->lport_fcport_map, nacl->nport_id);
734 	if (WARN_ON(node && (node != se_nacl))) {
735 		/*
736 		 * The nacl no longer matches what we think it should be.
737 		 * Most likely a new dynamic acl has been added while
738 		 * someone dropped the hardware lock.  It clearly is a
739 		 * bug elsewhere, but this bit can't make things worse.
740 		 */
741 		btree_insert32(&lport->lport_fcport_map, nacl->nport_id,
742 			       node, GFP_ATOMIC);
743 	}
744 
745 	pr_debug("Removed from fcport_map: %p for WWNN: 0x%016LX, port_id: 0x%06x\n",
746 	    se_nacl, nacl->nport_wwnn, nacl->nport_id);
747 	/*
748 	 * Now clear the se_nacl and session pointers from our HW lport lookup
749 	 * table mapping for this initiator's fabric S_ID and LOOP_ID entries.
750 	 *
751 	 * This is done ahead of callbacks into tcm_qla2xxx_free_session() ->
752 	 * target_wait_for_sess_cmds() before the session waits for outstanding
753 	 * I/O to complete, to avoid a race between session shutdown execution
754 	 * and incoming ATIOs or TMRs picking up a stale se_node_act reference.
755 	 */
756 	tcm_qla2xxx_clear_sess_lookup(lport, nacl, sess);
757 }
758 
759 static void tcm_qla2xxx_shutdown_sess(struct qla_tgt_sess *sess)
760 {
761 	assert_spin_locked(&sess->vha->hw->tgt.sess_lock);
762 	target_sess_cmd_list_set_waiting(sess->se_sess);
763 }
764 
765 static int tcm_qla2xxx_init_nodeacl(struct se_node_acl *se_nacl,
766 		const char *name)
767 {
768 	struct tcm_qla2xxx_nacl *nacl =
769 		container_of(se_nacl, struct tcm_qla2xxx_nacl, se_node_acl);
770 	u64 wwnn;
771 
772 	if (tcm_qla2xxx_parse_wwn(name, &wwnn, 1) < 0)
773 		return -EINVAL;
774 
775 	nacl->nport_wwnn = wwnn;
776 	tcm_qla2xxx_format_wwn(&nacl->nport_name[0], TCM_QLA2XXX_NAMELEN, wwnn);
777 
778 	return 0;
779 }
780 
781 /* Start items for tcm_qla2xxx_tpg_attrib_cit */
782 
783 #define DEF_QLA_TPG_ATTRIB(name)					\
784 									\
785 static ssize_t tcm_qla2xxx_tpg_attrib_##name##_show(			\
786 		struct config_item *item, char *page)			\
787 {									\
788 	struct se_portal_group *se_tpg = attrib_to_tpg(item);		\
789 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,		\
790 			struct tcm_qla2xxx_tpg, se_tpg);		\
791 									\
792 	return sprintf(page, "%u\n", tpg->tpg_attrib.name);	\
793 }									\
794 									\
795 static ssize_t tcm_qla2xxx_tpg_attrib_##name##_store(			\
796 		struct config_item *item, const char *page, size_t count) \
797 {									\
798 	struct se_portal_group *se_tpg = attrib_to_tpg(item);		\
799 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,		\
800 			struct tcm_qla2xxx_tpg, se_tpg);		\
801 	struct tcm_qla2xxx_tpg_attrib *a = &tpg->tpg_attrib;		\
802 	unsigned long val;						\
803 	int ret;							\
804 									\
805 	ret = kstrtoul(page, 0, &val);					\
806 	if (ret < 0) {							\
807 		pr_err("kstrtoul() failed with"				\
808 				" ret: %d\n", ret);			\
809 		return -EINVAL;						\
810 	}								\
811 									\
812 	if ((val != 0) && (val != 1)) {					\
813 		pr_err("Illegal boolean value %lu\n", val);		\
814 		return -EINVAL;						\
815 	}								\
816 									\
817 	a->name = val;							\
818 									\
819 	return count;							\
820 }									\
821 CONFIGFS_ATTR(tcm_qla2xxx_tpg_attrib_, name)
822 
823 DEF_QLA_TPG_ATTRIB(generate_node_acls);
824 DEF_QLA_TPG_ATTRIB(cache_dynamic_acls);
825 DEF_QLA_TPG_ATTRIB(demo_mode_write_protect);
826 DEF_QLA_TPG_ATTRIB(prod_mode_write_protect);
827 DEF_QLA_TPG_ATTRIB(demo_mode_login_only);
828 #ifdef CONFIG_TCM_QLA2XXX_DEBUG
829 DEF_QLA_TPG_ATTRIB(jam_host);
830 #endif
831 
832 static struct configfs_attribute *tcm_qla2xxx_tpg_attrib_attrs[] = {
833 	&tcm_qla2xxx_tpg_attrib_attr_generate_node_acls,
834 	&tcm_qla2xxx_tpg_attrib_attr_cache_dynamic_acls,
835 	&tcm_qla2xxx_tpg_attrib_attr_demo_mode_write_protect,
836 	&tcm_qla2xxx_tpg_attrib_attr_prod_mode_write_protect,
837 	&tcm_qla2xxx_tpg_attrib_attr_demo_mode_login_only,
838 #ifdef CONFIG_TCM_QLA2XXX_DEBUG
839 	&tcm_qla2xxx_tpg_attrib_attr_jam_host,
840 #endif
841 	NULL,
842 };
843 
844 /* End items for tcm_qla2xxx_tpg_attrib_cit */
845 
846 static ssize_t tcm_qla2xxx_tpg_enable_show(struct config_item *item,
847 		char *page)
848 {
849 	struct se_portal_group *se_tpg = to_tpg(item);
850 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
851 			struct tcm_qla2xxx_tpg, se_tpg);
852 
853 	return snprintf(page, PAGE_SIZE, "%d\n",
854 			atomic_read(&tpg->lport_tpg_enabled));
855 }
856 
857 static void tcm_qla2xxx_depend_tpg(struct work_struct *work)
858 {
859 	struct tcm_qla2xxx_tpg *base_tpg = container_of(work,
860 				struct tcm_qla2xxx_tpg, tpg_base_work);
861 	struct se_portal_group *se_tpg = &base_tpg->se_tpg;
862 	struct scsi_qla_host *base_vha = base_tpg->lport->qla_vha;
863 
864 	if (!target_depend_item(&se_tpg->tpg_group.cg_item)) {
865 		atomic_set(&base_tpg->lport_tpg_enabled, 1);
866 		qlt_enable_vha(base_vha);
867 	}
868 	complete(&base_tpg->tpg_base_comp);
869 }
870 
871 static void tcm_qla2xxx_undepend_tpg(struct work_struct *work)
872 {
873 	struct tcm_qla2xxx_tpg *base_tpg = container_of(work,
874 				struct tcm_qla2xxx_tpg, tpg_base_work);
875 	struct se_portal_group *se_tpg = &base_tpg->se_tpg;
876 	struct scsi_qla_host *base_vha = base_tpg->lport->qla_vha;
877 
878 	if (!qlt_stop_phase1(base_vha->vha_tgt.qla_tgt)) {
879 		atomic_set(&base_tpg->lport_tpg_enabled, 0);
880 		target_undepend_item(&se_tpg->tpg_group.cg_item);
881 	}
882 	complete(&base_tpg->tpg_base_comp);
883 }
884 
885 static ssize_t tcm_qla2xxx_tpg_enable_store(struct config_item *item,
886 		const char *page, size_t count)
887 {
888 	struct se_portal_group *se_tpg = to_tpg(item);
889 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
890 			struct tcm_qla2xxx_tpg, se_tpg);
891 	unsigned long op;
892 	int rc;
893 
894 	rc = kstrtoul(page, 0, &op);
895 	if (rc < 0) {
896 		pr_err("kstrtoul() returned %d\n", rc);
897 		return -EINVAL;
898 	}
899 	if ((op != 1) && (op != 0)) {
900 		pr_err("Illegal value for tpg_enable: %lu\n", op);
901 		return -EINVAL;
902 	}
903 	if (op) {
904 		if (atomic_read(&tpg->lport_tpg_enabled))
905 			return -EEXIST;
906 
907 		INIT_WORK(&tpg->tpg_base_work, tcm_qla2xxx_depend_tpg);
908 	} else {
909 		if (!atomic_read(&tpg->lport_tpg_enabled))
910 			return count;
911 
912 		INIT_WORK(&tpg->tpg_base_work, tcm_qla2xxx_undepend_tpg);
913 	}
914 	init_completion(&tpg->tpg_base_comp);
915 	schedule_work(&tpg->tpg_base_work);
916 	wait_for_completion(&tpg->tpg_base_comp);
917 
918 	if (op) {
919 		if (!atomic_read(&tpg->lport_tpg_enabled))
920 			return -ENODEV;
921 	} else {
922 		if (atomic_read(&tpg->lport_tpg_enabled))
923 			return -EPERM;
924 	}
925 	return count;
926 }
927 
928 static ssize_t tcm_qla2xxx_tpg_dynamic_sessions_show(struct config_item *item,
929 		char *page)
930 {
931 	return target_show_dynamic_sessions(to_tpg(item), page);
932 }
933 
934 static ssize_t tcm_qla2xxx_tpg_fabric_prot_type_store(struct config_item *item,
935 		const char *page, size_t count)
936 {
937 	struct se_portal_group *se_tpg = to_tpg(item);
938 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
939 				struct tcm_qla2xxx_tpg, se_tpg);
940 	unsigned long val;
941 	int ret = kstrtoul(page, 0, &val);
942 
943 	if (ret) {
944 		pr_err("kstrtoul() returned %d for fabric_prot_type\n", ret);
945 		return ret;
946 	}
947 	if (val != 0 && val != 1 && val != 3) {
948 		pr_err("Invalid qla2xxx fabric_prot_type: %lu\n", val);
949 		return -EINVAL;
950 	}
951 	tpg->tpg_attrib.fabric_prot_type = val;
952 
953 	return count;
954 }
955 
956 static ssize_t tcm_qla2xxx_tpg_fabric_prot_type_show(struct config_item *item,
957 		char *page)
958 {
959 	struct se_portal_group *se_tpg = to_tpg(item);
960 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
961 				struct tcm_qla2xxx_tpg, se_tpg);
962 
963 	return sprintf(page, "%d\n", tpg->tpg_attrib.fabric_prot_type);
964 }
965 
966 CONFIGFS_ATTR(tcm_qla2xxx_tpg_, enable);
967 CONFIGFS_ATTR_RO(tcm_qla2xxx_tpg_, dynamic_sessions);
968 CONFIGFS_ATTR(tcm_qla2xxx_tpg_, fabric_prot_type);
969 
970 static struct configfs_attribute *tcm_qla2xxx_tpg_attrs[] = {
971 	&tcm_qla2xxx_tpg_attr_enable,
972 	&tcm_qla2xxx_tpg_attr_dynamic_sessions,
973 	&tcm_qla2xxx_tpg_attr_fabric_prot_type,
974 	NULL,
975 };
976 
977 static struct se_portal_group *tcm_qla2xxx_make_tpg(
978 	struct se_wwn *wwn,
979 	struct config_group *group,
980 	const char *name)
981 {
982 	struct tcm_qla2xxx_lport *lport = container_of(wwn,
983 			struct tcm_qla2xxx_lport, lport_wwn);
984 	struct tcm_qla2xxx_tpg *tpg;
985 	unsigned long tpgt;
986 	int ret;
987 
988 	if (strstr(name, "tpgt_") != name)
989 		return ERR_PTR(-EINVAL);
990 	if (kstrtoul(name + 5, 10, &tpgt) || tpgt > USHRT_MAX)
991 		return ERR_PTR(-EINVAL);
992 
993 	if ((tpgt != 1)) {
994 		pr_err("In non NPIV mode, a single TPG=1 is used for HW port mappings\n");
995 		return ERR_PTR(-ENOSYS);
996 	}
997 
998 	tpg = kzalloc(sizeof(struct tcm_qla2xxx_tpg), GFP_KERNEL);
999 	if (!tpg) {
1000 		pr_err("Unable to allocate struct tcm_qla2xxx_tpg\n");
1001 		return ERR_PTR(-ENOMEM);
1002 	}
1003 	tpg->lport = lport;
1004 	tpg->lport_tpgt = tpgt;
1005 	/*
1006 	 * By default allow READ-ONLY TPG demo-mode access w/ cached dynamic
1007 	 * NodeACLs
1008 	 */
1009 	tpg->tpg_attrib.generate_node_acls = 1;
1010 	tpg->tpg_attrib.demo_mode_write_protect = 1;
1011 	tpg->tpg_attrib.cache_dynamic_acls = 1;
1012 	tpg->tpg_attrib.demo_mode_login_only = 1;
1013 	tpg->tpg_attrib.jam_host = 0;
1014 
1015 	ret = core_tpg_register(wwn, &tpg->se_tpg, SCSI_PROTOCOL_FCP);
1016 	if (ret < 0) {
1017 		kfree(tpg);
1018 		return NULL;
1019 	}
1020 
1021 	lport->tpg_1 = tpg;
1022 
1023 	return &tpg->se_tpg;
1024 }
1025 
1026 static void tcm_qla2xxx_drop_tpg(struct se_portal_group *se_tpg)
1027 {
1028 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
1029 			struct tcm_qla2xxx_tpg, se_tpg);
1030 	struct tcm_qla2xxx_lport *lport = tpg->lport;
1031 	struct scsi_qla_host *vha = lport->qla_vha;
1032 	/*
1033 	 * Call into qla2x_target.c LLD logic to shutdown the active
1034 	 * FC Nexuses and disable target mode operation for this qla_hw_data
1035 	 */
1036 	if (vha->vha_tgt.qla_tgt && !vha->vha_tgt.qla_tgt->tgt_stop)
1037 		qlt_stop_phase1(vha->vha_tgt.qla_tgt);
1038 
1039 	core_tpg_deregister(se_tpg);
1040 	/*
1041 	 * Clear local TPG=1 pointer for non NPIV mode.
1042 	 */
1043 	lport->tpg_1 = NULL;
1044 	kfree(tpg);
1045 }
1046 
1047 static ssize_t tcm_qla2xxx_npiv_tpg_enable_show(struct config_item *item,
1048 		char *page)
1049 {
1050 	return tcm_qla2xxx_tpg_enable_show(item, page);
1051 }
1052 
1053 static ssize_t tcm_qla2xxx_npiv_tpg_enable_store(struct config_item *item,
1054 		const char *page, size_t count)
1055 {
1056 	struct se_portal_group *se_tpg = to_tpg(item);
1057 	struct se_wwn *se_wwn = se_tpg->se_tpg_wwn;
1058 	struct tcm_qla2xxx_lport *lport = container_of(se_wwn,
1059 			struct tcm_qla2xxx_lport, lport_wwn);
1060 	struct scsi_qla_host *vha = lport->qla_vha;
1061 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
1062 			struct tcm_qla2xxx_tpg, se_tpg);
1063 	unsigned long op;
1064 	int rc;
1065 
1066 	rc = kstrtoul(page, 0, &op);
1067 	if (rc < 0) {
1068 		pr_err("kstrtoul() returned %d\n", rc);
1069 		return -EINVAL;
1070 	}
1071 	if ((op != 1) && (op != 0)) {
1072 		pr_err("Illegal value for tpg_enable: %lu\n", op);
1073 		return -EINVAL;
1074 	}
1075 	if (op) {
1076 		if (atomic_read(&tpg->lport_tpg_enabled))
1077 			return -EEXIST;
1078 
1079 		atomic_set(&tpg->lport_tpg_enabled, 1);
1080 		qlt_enable_vha(vha);
1081 	} else {
1082 		if (!atomic_read(&tpg->lport_tpg_enabled))
1083 			return count;
1084 
1085 		atomic_set(&tpg->lport_tpg_enabled, 0);
1086 		qlt_stop_phase1(vha->vha_tgt.qla_tgt);
1087 	}
1088 
1089 	return count;
1090 }
1091 
1092 CONFIGFS_ATTR(tcm_qla2xxx_npiv_tpg_, enable);
1093 
1094 static struct configfs_attribute *tcm_qla2xxx_npiv_tpg_attrs[] = {
1095         &tcm_qla2xxx_npiv_tpg_attr_enable,
1096         NULL,
1097 };
1098 
1099 static struct se_portal_group *tcm_qla2xxx_npiv_make_tpg(
1100 	struct se_wwn *wwn,
1101 	struct config_group *group,
1102 	const char *name)
1103 {
1104 	struct tcm_qla2xxx_lport *lport = container_of(wwn,
1105 			struct tcm_qla2xxx_lport, lport_wwn);
1106 	struct tcm_qla2xxx_tpg *tpg;
1107 	unsigned long tpgt;
1108 	int ret;
1109 
1110 	if (strstr(name, "tpgt_") != name)
1111 		return ERR_PTR(-EINVAL);
1112 	if (kstrtoul(name + 5, 10, &tpgt) || tpgt > USHRT_MAX)
1113 		return ERR_PTR(-EINVAL);
1114 
1115 	tpg = kzalloc(sizeof(struct tcm_qla2xxx_tpg), GFP_KERNEL);
1116 	if (!tpg) {
1117 		pr_err("Unable to allocate struct tcm_qla2xxx_tpg\n");
1118 		return ERR_PTR(-ENOMEM);
1119 	}
1120 	tpg->lport = lport;
1121 	tpg->lport_tpgt = tpgt;
1122 
1123 	/*
1124 	 * By default allow READ-ONLY TPG demo-mode access w/ cached dynamic
1125 	 * NodeACLs
1126 	 */
1127 	tpg->tpg_attrib.generate_node_acls = 1;
1128 	tpg->tpg_attrib.demo_mode_write_protect = 1;
1129 	tpg->tpg_attrib.cache_dynamic_acls = 1;
1130 	tpg->tpg_attrib.demo_mode_login_only = 1;
1131 
1132 	ret = core_tpg_register(wwn, &tpg->se_tpg, SCSI_PROTOCOL_FCP);
1133 	if (ret < 0) {
1134 		kfree(tpg);
1135 		return NULL;
1136 	}
1137 	lport->tpg_1 = tpg;
1138 	return &tpg->se_tpg;
1139 }
1140 
1141 /*
1142  * Expected to be called with struct qla_hw_data->tgt.sess_lock held
1143  */
1144 static struct qla_tgt_sess *tcm_qla2xxx_find_sess_by_s_id(
1145 	scsi_qla_host_t *vha,
1146 	const uint8_t *s_id)
1147 {
1148 	struct tcm_qla2xxx_lport *lport;
1149 	struct se_node_acl *se_nacl;
1150 	struct tcm_qla2xxx_nacl *nacl;
1151 	u32 key;
1152 
1153 	lport = vha->vha_tgt.target_lport_ptr;
1154 	if (!lport) {
1155 		pr_err("Unable to locate struct tcm_qla2xxx_lport\n");
1156 		dump_stack();
1157 		return NULL;
1158 	}
1159 
1160 	key = sid_to_key(s_id);
1161 	pr_debug("find_sess_by_s_id: 0x%06x\n", key);
1162 
1163 	se_nacl = btree_lookup32(&lport->lport_fcport_map, key);
1164 	if (!se_nacl) {
1165 		pr_debug("Unable to locate s_id: 0x%06x\n", key);
1166 		return NULL;
1167 	}
1168 	pr_debug("find_sess_by_s_id: located se_nacl: %p, initiatorname: %s\n",
1169 	    se_nacl, se_nacl->initiatorname);
1170 
1171 	nacl = container_of(se_nacl, struct tcm_qla2xxx_nacl, se_node_acl);
1172 	if (!nacl->qla_tgt_sess) {
1173 		pr_err("Unable to locate struct qla_tgt_sess\n");
1174 		return NULL;
1175 	}
1176 
1177 	return nacl->qla_tgt_sess;
1178 }
1179 
1180 /*
1181  * Expected to be called with struct qla_hw_data->tgt.sess_lock held
1182  */
1183 static void tcm_qla2xxx_set_sess_by_s_id(
1184 	struct tcm_qla2xxx_lport *lport,
1185 	struct se_node_acl *new_se_nacl,
1186 	struct tcm_qla2xxx_nacl *nacl,
1187 	struct se_session *se_sess,
1188 	struct qla_tgt_sess *qla_tgt_sess,
1189 	uint8_t *s_id)
1190 {
1191 	u32 key;
1192 	void *slot;
1193 	int rc;
1194 
1195 	key = sid_to_key(s_id);
1196 	pr_debug("set_sess_by_s_id: %06x\n", key);
1197 
1198 	slot = btree_lookup32(&lport->lport_fcport_map, key);
1199 	if (!slot) {
1200 		if (new_se_nacl) {
1201 			pr_debug("Setting up new fc_port entry to new_se_nacl\n");
1202 			nacl->nport_id = key;
1203 			rc = btree_insert32(&lport->lport_fcport_map, key,
1204 					new_se_nacl, GFP_ATOMIC);
1205 			if (rc)
1206 				printk(KERN_ERR "Unable to insert s_id into fcport_map: %06x\n",
1207 				    (int)key);
1208 		} else {
1209 			pr_debug("Wiping nonexisting fc_port entry\n");
1210 		}
1211 
1212 		qla_tgt_sess->se_sess = se_sess;
1213 		nacl->qla_tgt_sess = qla_tgt_sess;
1214 		return;
1215 	}
1216 
1217 	if (nacl->qla_tgt_sess) {
1218 		if (new_se_nacl == NULL) {
1219 			pr_debug("Clearing existing nacl->qla_tgt_sess and fc_port entry\n");
1220 			btree_remove32(&lport->lport_fcport_map, key);
1221 			nacl->qla_tgt_sess = NULL;
1222 			return;
1223 		}
1224 		pr_debug("Replacing existing nacl->qla_tgt_sess and fc_port entry\n");
1225 		btree_update32(&lport->lport_fcport_map, key, new_se_nacl);
1226 		qla_tgt_sess->se_sess = se_sess;
1227 		nacl->qla_tgt_sess = qla_tgt_sess;
1228 		return;
1229 	}
1230 
1231 	if (new_se_nacl == NULL) {
1232 		pr_debug("Clearing existing fc_port entry\n");
1233 		btree_remove32(&lport->lport_fcport_map, key);
1234 		return;
1235 	}
1236 
1237 	pr_debug("Replacing existing fc_port entry w/o active nacl->qla_tgt_sess\n");
1238 	btree_update32(&lport->lport_fcport_map, key, new_se_nacl);
1239 	qla_tgt_sess->se_sess = se_sess;
1240 	nacl->qla_tgt_sess = qla_tgt_sess;
1241 
1242 	pr_debug("Setup nacl->qla_tgt_sess %p by s_id for se_nacl: %p, initiatorname: %s\n",
1243 	    nacl->qla_tgt_sess, new_se_nacl, new_se_nacl->initiatorname);
1244 }
1245 
1246 /*
1247  * Expected to be called with struct qla_hw_data->tgt.sess_lock held
1248  */
1249 static struct qla_tgt_sess *tcm_qla2xxx_find_sess_by_loop_id(
1250 	scsi_qla_host_t *vha,
1251 	const uint16_t loop_id)
1252 {
1253 	struct tcm_qla2xxx_lport *lport;
1254 	struct se_node_acl *se_nacl;
1255 	struct tcm_qla2xxx_nacl *nacl;
1256 	struct tcm_qla2xxx_fc_loopid *fc_loopid;
1257 
1258 	lport = vha->vha_tgt.target_lport_ptr;
1259 	if (!lport) {
1260 		pr_err("Unable to locate struct tcm_qla2xxx_lport\n");
1261 		dump_stack();
1262 		return NULL;
1263 	}
1264 
1265 	pr_debug("find_sess_by_loop_id: Using loop_id: 0x%04x\n", loop_id);
1266 
1267 	fc_loopid = lport->lport_loopid_map + loop_id;
1268 	se_nacl = fc_loopid->se_nacl;
1269 	if (!se_nacl) {
1270 		pr_debug("Unable to locate se_nacl by loop_id: 0x%04x\n",
1271 		    loop_id);
1272 		return NULL;
1273 	}
1274 
1275 	nacl = container_of(se_nacl, struct tcm_qla2xxx_nacl, se_node_acl);
1276 
1277 	if (!nacl->qla_tgt_sess) {
1278 		pr_err("Unable to locate struct qla_tgt_sess\n");
1279 		return NULL;
1280 	}
1281 
1282 	return nacl->qla_tgt_sess;
1283 }
1284 
1285 /*
1286  * Expected to be called with struct qla_hw_data->tgt.sess_lock held
1287  */
1288 static void tcm_qla2xxx_set_sess_by_loop_id(
1289 	struct tcm_qla2xxx_lport *lport,
1290 	struct se_node_acl *new_se_nacl,
1291 	struct tcm_qla2xxx_nacl *nacl,
1292 	struct se_session *se_sess,
1293 	struct qla_tgt_sess *qla_tgt_sess,
1294 	uint16_t loop_id)
1295 {
1296 	struct se_node_acl *saved_nacl;
1297 	struct tcm_qla2xxx_fc_loopid *fc_loopid;
1298 
1299 	pr_debug("set_sess_by_loop_id: Using loop_id: 0x%04x\n", loop_id);
1300 
1301 	fc_loopid = &((struct tcm_qla2xxx_fc_loopid *)
1302 			lport->lport_loopid_map)[loop_id];
1303 
1304 	saved_nacl = fc_loopid->se_nacl;
1305 	if (!saved_nacl) {
1306 		pr_debug("Setting up new fc_loopid->se_nacl to new_se_nacl\n");
1307 		fc_loopid->se_nacl = new_se_nacl;
1308 		if (qla_tgt_sess->se_sess != se_sess)
1309 			qla_tgt_sess->se_sess = se_sess;
1310 		if (nacl->qla_tgt_sess != qla_tgt_sess)
1311 			nacl->qla_tgt_sess = qla_tgt_sess;
1312 		return;
1313 	}
1314 
1315 	if (nacl->qla_tgt_sess) {
1316 		if (new_se_nacl == NULL) {
1317 			pr_debug("Clearing nacl->qla_tgt_sess and fc_loopid->se_nacl\n");
1318 			fc_loopid->se_nacl = NULL;
1319 			nacl->qla_tgt_sess = NULL;
1320 			return;
1321 		}
1322 
1323 		pr_debug("Replacing existing nacl->qla_tgt_sess and fc_loopid->se_nacl\n");
1324 		fc_loopid->se_nacl = new_se_nacl;
1325 		if (qla_tgt_sess->se_sess != se_sess)
1326 			qla_tgt_sess->se_sess = se_sess;
1327 		if (nacl->qla_tgt_sess != qla_tgt_sess)
1328 			nacl->qla_tgt_sess = qla_tgt_sess;
1329 		return;
1330 	}
1331 
1332 	if (new_se_nacl == NULL) {
1333 		pr_debug("Clearing fc_loopid->se_nacl\n");
1334 		fc_loopid->se_nacl = NULL;
1335 		return;
1336 	}
1337 
1338 	pr_debug("Replacing existing fc_loopid->se_nacl w/o active nacl->qla_tgt_sess\n");
1339 	fc_loopid->se_nacl = new_se_nacl;
1340 	if (qla_tgt_sess->se_sess != se_sess)
1341 		qla_tgt_sess->se_sess = se_sess;
1342 	if (nacl->qla_tgt_sess != qla_tgt_sess)
1343 		nacl->qla_tgt_sess = qla_tgt_sess;
1344 
1345 	pr_debug("Setup nacl->qla_tgt_sess %p by loop_id for se_nacl: %p, initiatorname: %s\n",
1346 	    nacl->qla_tgt_sess, new_se_nacl, new_se_nacl->initiatorname);
1347 }
1348 
1349 /*
1350  * Should always be called with qla_hw_data->tgt.sess_lock held.
1351  */
1352 static void tcm_qla2xxx_clear_sess_lookup(struct tcm_qla2xxx_lport *lport,
1353 		struct tcm_qla2xxx_nacl *nacl, struct qla_tgt_sess *sess)
1354 {
1355 	struct se_session *se_sess = sess->se_sess;
1356 	unsigned char be_sid[3];
1357 
1358 	be_sid[0] = sess->s_id.b.domain;
1359 	be_sid[1] = sess->s_id.b.area;
1360 	be_sid[2] = sess->s_id.b.al_pa;
1361 
1362 	tcm_qla2xxx_set_sess_by_s_id(lport, NULL, nacl, se_sess,
1363 				sess, be_sid);
1364 	tcm_qla2xxx_set_sess_by_loop_id(lport, NULL, nacl, se_sess,
1365 				sess, sess->loop_id);
1366 }
1367 
1368 static void tcm_qla2xxx_free_session(struct qla_tgt_sess *sess)
1369 {
1370 	struct qla_tgt *tgt = sess->tgt;
1371 	struct qla_hw_data *ha = tgt->ha;
1372 	scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev);
1373 	struct se_session *se_sess;
1374 	struct tcm_qla2xxx_lport *lport;
1375 
1376 	BUG_ON(in_interrupt());
1377 
1378 	se_sess = sess->se_sess;
1379 	if (!se_sess) {
1380 		pr_err("struct qla_tgt_sess->se_sess is NULL\n");
1381 		dump_stack();
1382 		return;
1383 	}
1384 
1385 	lport = vha->vha_tgt.target_lport_ptr;
1386 	if (!lport) {
1387 		pr_err("Unable to locate struct tcm_qla2xxx_lport\n");
1388 		dump_stack();
1389 		return;
1390 	}
1391 	target_wait_for_sess_cmds(se_sess);
1392 
1393 	transport_deregister_session_configfs(sess->se_sess);
1394 	transport_deregister_session(sess->se_sess);
1395 }
1396 
1397 static int tcm_qla2xxx_session_cb(struct se_portal_group *se_tpg,
1398 				  struct se_session *se_sess, void *p)
1399 {
1400 	struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
1401 				struct tcm_qla2xxx_tpg, se_tpg);
1402 	struct tcm_qla2xxx_lport *lport = tpg->lport;
1403 	struct qla_hw_data *ha = lport->qla_vha->hw;
1404 	struct se_node_acl *se_nacl = se_sess->se_node_acl;
1405 	struct tcm_qla2xxx_nacl *nacl = container_of(se_nacl,
1406 				struct tcm_qla2xxx_nacl, se_node_acl);
1407 	struct qla_tgt_sess *qlat_sess = p;
1408 	uint16_t loop_id = qlat_sess->loop_id;
1409 	unsigned long flags;
1410 	unsigned char be_sid[3];
1411 
1412 	be_sid[0] = qlat_sess->s_id.b.domain;
1413 	be_sid[1] = qlat_sess->s_id.b.area;
1414 	be_sid[2] = qlat_sess->s_id.b.al_pa;
1415 
1416 	/*
1417 	 * And now setup se_nacl and session pointers into HW lport internal
1418 	 * mappings for fabric S_ID and LOOP_ID.
1419 	 */
1420 	spin_lock_irqsave(&ha->tgt.sess_lock, flags);
1421 	tcm_qla2xxx_set_sess_by_s_id(lport, se_nacl, nacl,
1422 				     se_sess, qlat_sess, be_sid);
1423 	tcm_qla2xxx_set_sess_by_loop_id(lport, se_nacl, nacl,
1424 					se_sess, qlat_sess, loop_id);
1425 	spin_unlock_irqrestore(&ha->tgt.sess_lock, flags);
1426 
1427 	return 0;
1428 }
1429 
1430 /*
1431  * Called via qlt_create_sess():ha->qla2x_tmpl->check_initiator_node_acl()
1432  * to locate struct se_node_acl
1433  */
1434 static int tcm_qla2xxx_check_initiator_node_acl(
1435 	scsi_qla_host_t *vha,
1436 	unsigned char *fc_wwpn,
1437 	struct qla_tgt_sess *qlat_sess)
1438 {
1439 	struct qla_hw_data *ha = vha->hw;
1440 	struct tcm_qla2xxx_lport *lport;
1441 	struct tcm_qla2xxx_tpg *tpg;
1442 	struct se_session *se_sess;
1443 	unsigned char port_name[36];
1444 	int num_tags = (ha->cur_fw_xcb_count) ? ha->cur_fw_xcb_count :
1445 		       TCM_QLA2XXX_DEFAULT_TAGS;
1446 
1447 	lport = vha->vha_tgt.target_lport_ptr;
1448 	if (!lport) {
1449 		pr_err("Unable to locate struct tcm_qla2xxx_lport\n");
1450 		dump_stack();
1451 		return -EINVAL;
1452 	}
1453 	/*
1454 	 * Locate the TPG=1 reference..
1455 	 */
1456 	tpg = lport->tpg_1;
1457 	if (!tpg) {
1458 		pr_err("Unable to lcoate struct tcm_qla2xxx_lport->tpg_1\n");
1459 		return -EINVAL;
1460 	}
1461 	/*
1462 	 * Format the FCP Initiator port_name into colon seperated values to
1463 	 * match the format by tcm_qla2xxx explict ConfigFS NodeACLs.
1464 	 */
1465 	memset(&port_name, 0, 36);
1466 	snprintf(port_name, sizeof(port_name), "%8phC", fc_wwpn);
1467 	/*
1468 	 * Locate our struct se_node_acl either from an explict NodeACL created
1469 	 * via ConfigFS, or via running in TPG demo mode.
1470 	 */
1471 	se_sess = target_alloc_session(&tpg->se_tpg, num_tags,
1472 				       sizeof(struct qla_tgt_cmd),
1473 				       TARGET_PROT_ALL, port_name,
1474 				       qlat_sess, tcm_qla2xxx_session_cb);
1475 	if (IS_ERR(se_sess))
1476 		return PTR_ERR(se_sess);
1477 
1478 	return 0;
1479 }
1480 
1481 static void tcm_qla2xxx_update_sess(struct qla_tgt_sess *sess, port_id_t s_id,
1482 				    uint16_t loop_id, bool conf_compl_supported)
1483 {
1484 	struct qla_tgt *tgt = sess->tgt;
1485 	struct qla_hw_data *ha = tgt->ha;
1486 	scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev);
1487 	struct tcm_qla2xxx_lport *lport = vha->vha_tgt.target_lport_ptr;
1488 	struct se_node_acl *se_nacl = sess->se_sess->se_node_acl;
1489 	struct tcm_qla2xxx_nacl *nacl = container_of(se_nacl,
1490 			struct tcm_qla2xxx_nacl, se_node_acl);
1491 	u32 key;
1492 
1493 
1494 	if (sess->loop_id != loop_id || sess->s_id.b24 != s_id.b24)
1495 		pr_info("Updating session %p from port %8phC loop_id %d -> %d s_id %x:%x:%x -> %x:%x:%x\n",
1496 		    sess, sess->port_name,
1497 		    sess->loop_id, loop_id, sess->s_id.b.domain,
1498 		    sess->s_id.b.area, sess->s_id.b.al_pa, s_id.b.domain,
1499 		    s_id.b.area, s_id.b.al_pa);
1500 
1501 	if (sess->loop_id != loop_id) {
1502 		/*
1503 		 * Because we can shuffle loop IDs around and we
1504 		 * update different sessions non-atomically, we might
1505 		 * have overwritten this session's old loop ID
1506 		 * already, and we might end up overwriting some other
1507 		 * session that will be updated later.  So we have to
1508 		 * be extra careful and we can't warn about those things...
1509 		 */
1510 		if (lport->lport_loopid_map[sess->loop_id].se_nacl == se_nacl)
1511 			lport->lport_loopid_map[sess->loop_id].se_nacl = NULL;
1512 
1513 		lport->lport_loopid_map[loop_id].se_nacl = se_nacl;
1514 
1515 		sess->loop_id = loop_id;
1516 	}
1517 
1518 	if (sess->s_id.b24 != s_id.b24) {
1519 		key = (((u32) sess->s_id.b.domain << 16) |
1520 		       ((u32) sess->s_id.b.area   <<  8) |
1521 		       ((u32) sess->s_id.b.al_pa));
1522 
1523 		if (btree_lookup32(&lport->lport_fcport_map, key))
1524 			WARN(btree_remove32(&lport->lport_fcport_map, key) != se_nacl,
1525 			     "Found wrong se_nacl when updating s_id %x:%x:%x\n",
1526 			     sess->s_id.b.domain, sess->s_id.b.area, sess->s_id.b.al_pa);
1527 		else
1528 			WARN(1, "No lport_fcport_map entry for s_id %x:%x:%x\n",
1529 			     sess->s_id.b.domain, sess->s_id.b.area, sess->s_id.b.al_pa);
1530 
1531 		key = (((u32) s_id.b.domain << 16) |
1532 		       ((u32) s_id.b.area   <<  8) |
1533 		       ((u32) s_id.b.al_pa));
1534 
1535 		if (btree_lookup32(&lport->lport_fcport_map, key)) {
1536 			WARN(1, "Already have lport_fcport_map entry for s_id %x:%x:%x\n",
1537 			     s_id.b.domain, s_id.b.area, s_id.b.al_pa);
1538 			btree_update32(&lport->lport_fcport_map, key, se_nacl);
1539 		} else {
1540 			btree_insert32(&lport->lport_fcport_map, key, se_nacl, GFP_ATOMIC);
1541 		}
1542 
1543 		sess->s_id = s_id;
1544 		nacl->nport_id = key;
1545 	}
1546 
1547 	sess->conf_compl_supported = conf_compl_supported;
1548 
1549 	/* Reset logout parameters to default */
1550 	sess->logout_on_delete = 1;
1551 	sess->keep_nport_handle = 0;
1552 }
1553 
1554 /*
1555  * Calls into tcm_qla2xxx used by qla2xxx LLD I/O path.
1556  */
1557 static struct qla_tgt_func_tmpl tcm_qla2xxx_template = {
1558 	.handle_cmd		= tcm_qla2xxx_handle_cmd,
1559 	.handle_data		= tcm_qla2xxx_handle_data,
1560 	.handle_dif_err		= tcm_qla2xxx_handle_dif_err,
1561 	.handle_tmr		= tcm_qla2xxx_handle_tmr,
1562 	.free_cmd		= tcm_qla2xxx_free_cmd,
1563 	.free_mcmd		= tcm_qla2xxx_free_mcmd,
1564 	.free_session		= tcm_qla2xxx_free_session,
1565 	.update_sess		= tcm_qla2xxx_update_sess,
1566 	.check_initiator_node_acl = tcm_qla2xxx_check_initiator_node_acl,
1567 	.find_sess_by_s_id	= tcm_qla2xxx_find_sess_by_s_id,
1568 	.find_sess_by_loop_id	= tcm_qla2xxx_find_sess_by_loop_id,
1569 	.clear_nacl_from_fcport_map = tcm_qla2xxx_clear_nacl_from_fcport_map,
1570 	.shutdown_sess		= tcm_qla2xxx_shutdown_sess,
1571 };
1572 
1573 static int tcm_qla2xxx_init_lport(struct tcm_qla2xxx_lport *lport)
1574 {
1575 	int rc;
1576 
1577 	rc = btree_init32(&lport->lport_fcport_map);
1578 	if (rc) {
1579 		pr_err("Unable to initialize lport->lport_fcport_map btree\n");
1580 		return rc;
1581 	}
1582 
1583 	lport->lport_loopid_map = vmalloc(sizeof(struct tcm_qla2xxx_fc_loopid) *
1584 				65536);
1585 	if (!lport->lport_loopid_map) {
1586 		pr_err("Unable to allocate lport->lport_loopid_map of %zu bytes\n",
1587 		    sizeof(struct tcm_qla2xxx_fc_loopid) * 65536);
1588 		btree_destroy32(&lport->lport_fcport_map);
1589 		return -ENOMEM;
1590 	}
1591 	memset(lport->lport_loopid_map, 0, sizeof(struct tcm_qla2xxx_fc_loopid)
1592 	       * 65536);
1593 	pr_debug("qla2xxx: Allocated lport_loopid_map of %zu bytes\n",
1594 	       sizeof(struct tcm_qla2xxx_fc_loopid) * 65536);
1595 	return 0;
1596 }
1597 
1598 static int tcm_qla2xxx_lport_register_cb(struct scsi_qla_host *vha,
1599 					 void *target_lport_ptr,
1600 					 u64 npiv_wwpn, u64 npiv_wwnn)
1601 {
1602 	struct qla_hw_data *ha = vha->hw;
1603 	struct tcm_qla2xxx_lport *lport =
1604 			(struct tcm_qla2xxx_lport *)target_lport_ptr;
1605 	/*
1606 	 * Setup tgt_ops, local pointer to vha and target_lport_ptr
1607 	 */
1608 	ha->tgt.tgt_ops = &tcm_qla2xxx_template;
1609 	vha->vha_tgt.target_lport_ptr = target_lport_ptr;
1610 	lport->qla_vha = vha;
1611 
1612 	return 0;
1613 }
1614 
1615 static struct se_wwn *tcm_qla2xxx_make_lport(
1616 	struct target_fabric_configfs *tf,
1617 	struct config_group *group,
1618 	const char *name)
1619 {
1620 	struct tcm_qla2xxx_lport *lport;
1621 	u64 wwpn;
1622 	int ret = -ENODEV;
1623 
1624 	if (tcm_qla2xxx_parse_wwn(name, &wwpn, 1) < 0)
1625 		return ERR_PTR(-EINVAL);
1626 
1627 	lport = kzalloc(sizeof(struct tcm_qla2xxx_lport), GFP_KERNEL);
1628 	if (!lport) {
1629 		pr_err("Unable to allocate struct tcm_qla2xxx_lport\n");
1630 		return ERR_PTR(-ENOMEM);
1631 	}
1632 	lport->lport_wwpn = wwpn;
1633 	tcm_qla2xxx_format_wwn(&lport->lport_name[0], TCM_QLA2XXX_NAMELEN,
1634 				wwpn);
1635 	sprintf(lport->lport_naa_name, "naa.%016llx", (unsigned long long) wwpn);
1636 
1637 	ret = tcm_qla2xxx_init_lport(lport);
1638 	if (ret != 0)
1639 		goto out;
1640 
1641 	ret = qlt_lport_register(lport, wwpn, 0, 0,
1642 				 tcm_qla2xxx_lport_register_cb);
1643 	if (ret != 0)
1644 		goto out_lport;
1645 
1646 	return &lport->lport_wwn;
1647 out_lport:
1648 	vfree(lport->lport_loopid_map);
1649 	btree_destroy32(&lport->lport_fcport_map);
1650 out:
1651 	kfree(lport);
1652 	return ERR_PTR(ret);
1653 }
1654 
1655 static void tcm_qla2xxx_drop_lport(struct se_wwn *wwn)
1656 {
1657 	struct tcm_qla2xxx_lport *lport = container_of(wwn,
1658 			struct tcm_qla2xxx_lport, lport_wwn);
1659 	struct scsi_qla_host *vha = lport->qla_vha;
1660 	struct se_node_acl *node;
1661 	u32 key = 0;
1662 
1663 	/*
1664 	 * Call into qla2x_target.c LLD logic to complete the
1665 	 * shutdown of struct qla_tgt after the call to
1666 	 * qlt_stop_phase1() from tcm_qla2xxx_drop_tpg() above..
1667 	 */
1668 	if (vha->vha_tgt.qla_tgt && !vha->vha_tgt.qla_tgt->tgt_stopped)
1669 		qlt_stop_phase2(vha->vha_tgt.qla_tgt);
1670 
1671 	qlt_lport_deregister(vha);
1672 
1673 	vfree(lport->lport_loopid_map);
1674 	btree_for_each_safe32(&lport->lport_fcport_map, key, node)
1675 		btree_remove32(&lport->lport_fcport_map, key);
1676 	btree_destroy32(&lport->lport_fcport_map);
1677 	kfree(lport);
1678 }
1679 
1680 static int tcm_qla2xxx_lport_register_npiv_cb(struct scsi_qla_host *base_vha,
1681 					      void *target_lport_ptr,
1682 					      u64 npiv_wwpn, u64 npiv_wwnn)
1683 {
1684 	struct fc_vport *vport;
1685 	struct Scsi_Host *sh = base_vha->host;
1686 	struct scsi_qla_host *npiv_vha;
1687 	struct tcm_qla2xxx_lport *lport =
1688 			(struct tcm_qla2xxx_lport *)target_lport_ptr;
1689 	struct tcm_qla2xxx_lport *base_lport =
1690 			(struct tcm_qla2xxx_lport *)base_vha->vha_tgt.target_lport_ptr;
1691 	struct fc_vport_identifiers vport_id;
1692 
1693 	if (!qla_tgt_mode_enabled(base_vha)) {
1694 		pr_err("qla2xxx base_vha not enabled for target mode\n");
1695 		return -EPERM;
1696 	}
1697 
1698 	if (!base_lport || !base_lport->tpg_1 ||
1699 	    !atomic_read(&base_lport->tpg_1->lport_tpg_enabled)) {
1700 		pr_err("qla2xxx base_lport or tpg_1 not available\n");
1701 		return -EPERM;
1702 	}
1703 
1704 	memset(&vport_id, 0, sizeof(vport_id));
1705 	vport_id.port_name = npiv_wwpn;
1706 	vport_id.node_name = npiv_wwnn;
1707 	vport_id.roles = FC_PORT_ROLE_FCP_INITIATOR;
1708 	vport_id.vport_type = FC_PORTTYPE_NPIV;
1709 	vport_id.disable = false;
1710 
1711 	vport = fc_vport_create(sh, 0, &vport_id);
1712 	if (!vport) {
1713 		pr_err("fc_vport_create failed for qla2xxx_npiv\n");
1714 		return -ENODEV;
1715 	}
1716 	/*
1717 	 * Setup local pointer to NPIV vhba + target_lport_ptr
1718 	 */
1719 	npiv_vha = (struct scsi_qla_host *)vport->dd_data;
1720 	npiv_vha->vha_tgt.target_lport_ptr = target_lport_ptr;
1721 	lport->qla_vha = npiv_vha;
1722 	scsi_host_get(npiv_vha->host);
1723 	return 0;
1724 }
1725 
1726 
1727 static struct se_wwn *tcm_qla2xxx_npiv_make_lport(
1728 	struct target_fabric_configfs *tf,
1729 	struct config_group *group,
1730 	const char *name)
1731 {
1732 	struct tcm_qla2xxx_lport *lport;
1733 	u64 phys_wwpn, npiv_wwpn, npiv_wwnn;
1734 	char *p, tmp[128];
1735 	int ret;
1736 
1737 	snprintf(tmp, 128, "%s", name);
1738 
1739 	p = strchr(tmp, '@');
1740 	if (!p) {
1741 		pr_err("Unable to locate NPIV '@' seperator\n");
1742 		return ERR_PTR(-EINVAL);
1743 	}
1744 	*p++ = '\0';
1745 
1746 	if (tcm_qla2xxx_parse_wwn(tmp, &phys_wwpn, 1) < 0)
1747 		return ERR_PTR(-EINVAL);
1748 
1749 	if (tcm_qla2xxx_npiv_parse_wwn(p, strlen(p)+1,
1750 				       &npiv_wwpn, &npiv_wwnn) < 0)
1751 		return ERR_PTR(-EINVAL);
1752 
1753 	lport = kzalloc(sizeof(struct tcm_qla2xxx_lport), GFP_KERNEL);
1754 	if (!lport) {
1755 		pr_err("Unable to allocate struct tcm_qla2xxx_lport for NPIV\n");
1756 		return ERR_PTR(-ENOMEM);
1757 	}
1758 	lport->lport_npiv_wwpn = npiv_wwpn;
1759 	lport->lport_npiv_wwnn = npiv_wwnn;
1760 	sprintf(lport->lport_naa_name, "naa.%016llx", (unsigned long long) npiv_wwpn);
1761 
1762 	ret = tcm_qla2xxx_init_lport(lport);
1763 	if (ret != 0)
1764 		goto out;
1765 
1766 	ret = qlt_lport_register(lport, phys_wwpn, npiv_wwpn, npiv_wwnn,
1767 				 tcm_qla2xxx_lport_register_npiv_cb);
1768 	if (ret != 0)
1769 		goto out_lport;
1770 
1771 	return &lport->lport_wwn;
1772 out_lport:
1773 	vfree(lport->lport_loopid_map);
1774 	btree_destroy32(&lport->lport_fcport_map);
1775 out:
1776 	kfree(lport);
1777 	return ERR_PTR(ret);
1778 }
1779 
1780 static void tcm_qla2xxx_npiv_drop_lport(struct se_wwn *wwn)
1781 {
1782 	struct tcm_qla2xxx_lport *lport = container_of(wwn,
1783 			struct tcm_qla2xxx_lport, lport_wwn);
1784 	struct scsi_qla_host *npiv_vha = lport->qla_vha;
1785 	struct qla_hw_data *ha = npiv_vha->hw;
1786 	scsi_qla_host_t *base_vha = pci_get_drvdata(ha->pdev);
1787 
1788 	scsi_host_put(npiv_vha->host);
1789 	/*
1790 	 * Notify libfc that we want to release the vha->fc_vport
1791 	 */
1792 	fc_vport_terminate(npiv_vha->fc_vport);
1793 	scsi_host_put(base_vha->host);
1794 	kfree(lport);
1795 }
1796 
1797 
1798 static ssize_t tcm_qla2xxx_wwn_version_show(struct config_item *item,
1799 		char *page)
1800 {
1801 	return sprintf(page,
1802 	    "TCM QLOGIC QLA2XXX NPIV capable fabric module %s on %s/%s on "
1803 	    UTS_RELEASE"\n", TCM_QLA2XXX_VERSION, utsname()->sysname,
1804 	    utsname()->machine);
1805 }
1806 
1807 CONFIGFS_ATTR_RO(tcm_qla2xxx_wwn_, version);
1808 
1809 static struct configfs_attribute *tcm_qla2xxx_wwn_attrs[] = {
1810 	&tcm_qla2xxx_wwn_attr_version,
1811 	NULL,
1812 };
1813 
1814 static const struct target_core_fabric_ops tcm_qla2xxx_ops = {
1815 	.module				= THIS_MODULE,
1816 	.name				= "qla2xxx",
1817 	.node_acl_size			= sizeof(struct tcm_qla2xxx_nacl),
1818 	/*
1819 	 * XXX: Limit assumes single page per scatter-gather-list entry.
1820 	 * Current maximum is ~4.9 MB per se_cmd->t_data_sg with PAGE_SIZE=4096
1821 	 */
1822 	.max_data_sg_nents		= 1200,
1823 	.get_fabric_name		= tcm_qla2xxx_get_fabric_name,
1824 	.tpg_get_wwn			= tcm_qla2xxx_get_fabric_wwn,
1825 	.tpg_get_tag			= tcm_qla2xxx_get_tag,
1826 	.tpg_check_demo_mode		= tcm_qla2xxx_check_demo_mode,
1827 	.tpg_check_demo_mode_cache	= tcm_qla2xxx_check_demo_mode_cache,
1828 	.tpg_check_demo_mode_write_protect =
1829 					tcm_qla2xxx_check_demo_write_protect,
1830 	.tpg_check_prod_mode_write_protect =
1831 					tcm_qla2xxx_check_prod_write_protect,
1832 	.tpg_check_prot_fabric_only	= tcm_qla2xxx_check_prot_fabric_only,
1833 	.tpg_check_demo_mode_login_only = tcm_qla2xxx_check_demo_mode_login_only,
1834 	.tpg_get_inst_index		= tcm_qla2xxx_tpg_get_inst_index,
1835 	.check_stop_free		= tcm_qla2xxx_check_stop_free,
1836 	.release_cmd			= tcm_qla2xxx_release_cmd,
1837 	.close_session			= tcm_qla2xxx_close_session,
1838 	.sess_get_index			= tcm_qla2xxx_sess_get_index,
1839 	.sess_get_initiator_sid		= NULL,
1840 	.write_pending			= tcm_qla2xxx_write_pending,
1841 	.write_pending_status		= tcm_qla2xxx_write_pending_status,
1842 	.set_default_node_attributes	= tcm_qla2xxx_set_default_node_attrs,
1843 	.get_cmd_state			= tcm_qla2xxx_get_cmd_state,
1844 	.queue_data_in			= tcm_qla2xxx_queue_data_in,
1845 	.queue_status			= tcm_qla2xxx_queue_status,
1846 	.queue_tm_rsp			= tcm_qla2xxx_queue_tm_rsp,
1847 	.aborted_task			= tcm_qla2xxx_aborted_task,
1848 	/*
1849 	 * Setup function pointers for generic logic in
1850 	 * target_core_fabric_configfs.c
1851 	 */
1852 	.fabric_make_wwn		= tcm_qla2xxx_make_lport,
1853 	.fabric_drop_wwn		= tcm_qla2xxx_drop_lport,
1854 	.fabric_make_tpg		= tcm_qla2xxx_make_tpg,
1855 	.fabric_drop_tpg		= tcm_qla2xxx_drop_tpg,
1856 	.fabric_init_nodeacl		= tcm_qla2xxx_init_nodeacl,
1857 
1858 	.tfc_wwn_attrs			= tcm_qla2xxx_wwn_attrs,
1859 	.tfc_tpg_base_attrs		= tcm_qla2xxx_tpg_attrs,
1860 	.tfc_tpg_attrib_attrs		= tcm_qla2xxx_tpg_attrib_attrs,
1861 };
1862 
1863 static const struct target_core_fabric_ops tcm_qla2xxx_npiv_ops = {
1864 	.module				= THIS_MODULE,
1865 	.name				= "qla2xxx_npiv",
1866 	.node_acl_size			= sizeof(struct tcm_qla2xxx_nacl),
1867 	.get_fabric_name		= tcm_qla2xxx_npiv_get_fabric_name,
1868 	.tpg_get_wwn			= tcm_qla2xxx_get_fabric_wwn,
1869 	.tpg_get_tag			= tcm_qla2xxx_get_tag,
1870 	.tpg_check_demo_mode		= tcm_qla2xxx_check_demo_mode,
1871 	.tpg_check_demo_mode_cache	= tcm_qla2xxx_check_demo_mode_cache,
1872 	.tpg_check_demo_mode_write_protect = tcm_qla2xxx_check_demo_mode,
1873 	.tpg_check_prod_mode_write_protect =
1874 	    tcm_qla2xxx_check_prod_write_protect,
1875 	.tpg_check_demo_mode_login_only	= tcm_qla2xxx_check_demo_mode_login_only,
1876 	.tpg_get_inst_index		= tcm_qla2xxx_tpg_get_inst_index,
1877 	.check_stop_free                = tcm_qla2xxx_check_stop_free,
1878 	.release_cmd			= tcm_qla2xxx_release_cmd,
1879 	.close_session			= tcm_qla2xxx_close_session,
1880 	.sess_get_index			= tcm_qla2xxx_sess_get_index,
1881 	.sess_get_initiator_sid		= NULL,
1882 	.write_pending			= tcm_qla2xxx_write_pending,
1883 	.write_pending_status		= tcm_qla2xxx_write_pending_status,
1884 	.set_default_node_attributes	= tcm_qla2xxx_set_default_node_attrs,
1885 	.get_cmd_state			= tcm_qla2xxx_get_cmd_state,
1886 	.queue_data_in			= tcm_qla2xxx_queue_data_in,
1887 	.queue_status			= tcm_qla2xxx_queue_status,
1888 	.queue_tm_rsp			= tcm_qla2xxx_queue_tm_rsp,
1889 	.aborted_task			= tcm_qla2xxx_aborted_task,
1890 	/*
1891 	 * Setup function pointers for generic logic in
1892 	 * target_core_fabric_configfs.c
1893 	 */
1894 	.fabric_make_wwn		= tcm_qla2xxx_npiv_make_lport,
1895 	.fabric_drop_wwn		= tcm_qla2xxx_npiv_drop_lport,
1896 	.fabric_make_tpg		= tcm_qla2xxx_npiv_make_tpg,
1897 	.fabric_drop_tpg		= tcm_qla2xxx_drop_tpg,
1898 	.fabric_init_nodeacl		= tcm_qla2xxx_init_nodeacl,
1899 
1900 	.tfc_wwn_attrs			= tcm_qla2xxx_wwn_attrs,
1901 	.tfc_tpg_base_attrs		= tcm_qla2xxx_npiv_tpg_attrs,
1902 };
1903 
1904 static int tcm_qla2xxx_register_configfs(void)
1905 {
1906 	int ret;
1907 
1908 	pr_debug("TCM QLOGIC QLA2XXX fabric module %s on %s/%s on "
1909 	    UTS_RELEASE"\n", TCM_QLA2XXX_VERSION, utsname()->sysname,
1910 	    utsname()->machine);
1911 
1912 	ret = target_register_template(&tcm_qla2xxx_ops);
1913 	if (ret)
1914 		return ret;
1915 
1916 	ret = target_register_template(&tcm_qla2xxx_npiv_ops);
1917 	if (ret)
1918 		goto out_fabric;
1919 
1920 	tcm_qla2xxx_free_wq = alloc_workqueue("tcm_qla2xxx_free",
1921 						WQ_MEM_RECLAIM, 0);
1922 	if (!tcm_qla2xxx_free_wq) {
1923 		ret = -ENOMEM;
1924 		goto out_fabric_npiv;
1925 	}
1926 
1927 	tcm_qla2xxx_cmd_wq = alloc_workqueue("tcm_qla2xxx_cmd", 0, 0);
1928 	if (!tcm_qla2xxx_cmd_wq) {
1929 		ret = -ENOMEM;
1930 		goto out_free_wq;
1931 	}
1932 
1933 	return 0;
1934 
1935 out_free_wq:
1936 	destroy_workqueue(tcm_qla2xxx_free_wq);
1937 out_fabric_npiv:
1938 	target_unregister_template(&tcm_qla2xxx_npiv_ops);
1939 out_fabric:
1940 	target_unregister_template(&tcm_qla2xxx_ops);
1941 	return ret;
1942 }
1943 
1944 static void tcm_qla2xxx_deregister_configfs(void)
1945 {
1946 	destroy_workqueue(tcm_qla2xxx_cmd_wq);
1947 	destroy_workqueue(tcm_qla2xxx_free_wq);
1948 
1949 	target_unregister_template(&tcm_qla2xxx_ops);
1950 	target_unregister_template(&tcm_qla2xxx_npiv_ops);
1951 }
1952 
1953 static int __init tcm_qla2xxx_init(void)
1954 {
1955 	int ret;
1956 
1957 	ret = tcm_qla2xxx_register_configfs();
1958 	if (ret < 0)
1959 		return ret;
1960 
1961 	return 0;
1962 }
1963 
1964 static void __exit tcm_qla2xxx_exit(void)
1965 {
1966 	tcm_qla2xxx_deregister_configfs();
1967 }
1968 
1969 MODULE_DESCRIPTION("TCM QLA24XX+ series NPIV enabled fabric driver");
1970 MODULE_LICENSE("GPL");
1971 module_init(tcm_qla2xxx_init);
1972 module_exit(tcm_qla2xxx_exit);
1973