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