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