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