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