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/init.h>
  31 #include <linux/list.h>
  32 #include <linux/slab.h>
  33 #include <linux/kthread.h>
  34 #include <linux/types.h>
  35 #include <linux/string.h>
  36 #include <linux/configfs.h>
  37 #include <linux/ctype.h>
  38 #include <asm/unaligned.h>
  39 #include <scsi/scsi.h>
  40 #include <scsi/scsi_host.h>
  41 #include <scsi/scsi_device.h>
  42 #include <scsi/scsi_cmnd.h>
  43 #include <target/target_core_base.h>
  44 #include <target/target_core_fabric.h>
  45 #include <target/target_core_fabric_configfs.h>
  46 #include <target/target_core_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 struct workqueue_struct *tcm_qla2xxx_free_wq;
  54 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 u8 tcm_qla2xxx_get_fabric_proto_ident(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         u8 proto_id;
 196
 197         switch (lport->lport_proto_id) {
 198         case SCSI_PROTOCOL_FCP:
 199         default:
 200                 proto_id = fc_get_fabric_proto_ident(se_tpg);
 201                 break;
 202         }
 203
 204         return proto_id;
 205 }
 206
 207 static char *tcm_qla2xxx_get_fabric_wwn(struct se_portal_group *se_tpg)
 208 {
 209         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 210                                 struct tcm_qla2xxx_tpg, se_tpg);
 211         struct tcm_qla2xxx_lport *lport = tpg->lport;
 212
 213         return lport->lport_naa_name;
 214 }
 215
 216 static u16 tcm_qla2xxx_get_tag(struct se_portal_group *se_tpg)
 217 {
 218         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 219                                 struct tcm_qla2xxx_tpg, se_tpg);
 220         return tpg->lport_tpgt;
 221 }
 222
 223 static u32 tcm_qla2xxx_get_default_depth(struct se_portal_group *se_tpg)
 224 {
 225         return 1;
 226 }
 227
 228 static u32 tcm_qla2xxx_get_pr_transport_id(
 229         struct se_portal_group *se_tpg,
 230         struct se_node_acl *se_nacl,
 231         struct t10_pr_registration *pr_reg,
 232         int *format_code,
 233         unsigned char *buf)
 234 {
 235         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 236                                 struct tcm_qla2xxx_tpg, se_tpg);
 237         struct tcm_qla2xxx_lport *lport = tpg->lport;
 238         int ret = 0;
 239
 240         switch (lport->lport_proto_id) {
 241         case SCSI_PROTOCOL_FCP:
 242         default:
 243                 ret = fc_get_pr_transport_id(se_tpg, se_nacl, pr_reg,
 244                                         format_code, buf);
 245                 break;
 246         }
 247
 248         return ret;
 249 }
 250
 251 static u32 tcm_qla2xxx_get_pr_transport_id_len(
 252         struct se_portal_group *se_tpg,
 253         struct se_node_acl *se_nacl,
 254         struct t10_pr_registration *pr_reg,
 255         int *format_code)
 256 {
 257         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 258                                 struct tcm_qla2xxx_tpg, se_tpg);
 259         struct tcm_qla2xxx_lport *lport = tpg->lport;
 260         int ret = 0;
 261
 262         switch (lport->lport_proto_id) {
 263         case SCSI_PROTOCOL_FCP:
 264         default:
 265                 ret = fc_get_pr_transport_id_len(se_tpg, se_nacl, pr_reg,
 266                                         format_code);
 267                 break;
 268         }
 269
 270         return ret;
 271 }
 272
 273 static char *tcm_qla2xxx_parse_pr_out_transport_id(
 274         struct se_portal_group *se_tpg,
 275         const char *buf,
 276         u32 *out_tid_len,
 277         char **port_nexus_ptr)
 278 {
 279         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 280                                 struct tcm_qla2xxx_tpg, se_tpg);
 281         struct tcm_qla2xxx_lport *lport = tpg->lport;
 282         char *tid = NULL;
 283
 284         switch (lport->lport_proto_id) {
 285         case SCSI_PROTOCOL_FCP:
 286         default:
 287                 tid = fc_parse_pr_out_transport_id(se_tpg, buf, out_tid_len,
 288                                         port_nexus_ptr);
 289                 break;
 290         }
 291
 292         return tid;
 293 }
 294
 295 static int tcm_qla2xxx_check_demo_mode(struct se_portal_group *se_tpg)
 296 {
 297         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 298                                 struct tcm_qla2xxx_tpg, se_tpg);
 299
 300         return tpg->tpg_attrib.generate_node_acls;
 301 }
 302
 303 static int tcm_qla2xxx_check_demo_mode_cache(struct se_portal_group *se_tpg)
 304 {
 305         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 306                                 struct tcm_qla2xxx_tpg, se_tpg);
 307
 308         return tpg->tpg_attrib.cache_dynamic_acls;
 309 }
 310
 311 static int tcm_qla2xxx_check_demo_write_protect(struct se_portal_group *se_tpg)
 312 {
 313         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 314                                 struct tcm_qla2xxx_tpg, se_tpg);
 315
 316         return tpg->tpg_attrib.demo_mode_write_protect;
 317 }
 318
 319 static int tcm_qla2xxx_check_prod_write_protect(struct se_portal_group *se_tpg)
 320 {
 321         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 322                                 struct tcm_qla2xxx_tpg, se_tpg);
 323
 324         return tpg->tpg_attrib.prod_mode_write_protect;
 325 }
 326
 327 static int tcm_qla2xxx_check_demo_mode_login_only(struct se_portal_group *se_tpg)
 328 {
 329         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 330                                 struct tcm_qla2xxx_tpg, se_tpg);
 331
 332         return tpg->tpg_attrib.demo_mode_login_only;
 333 }
 334
 335 static struct se_node_acl *tcm_qla2xxx_alloc_fabric_acl(
 336         struct se_portal_group *se_tpg)
 337 {
 338         struct tcm_qla2xxx_nacl *nacl;
 339
 340         nacl = kzalloc(sizeof(struct tcm_qla2xxx_nacl), GFP_KERNEL);
 341         if (!nacl) {
 342                 pr_err("Unable to allocate struct tcm_qla2xxx_nacl\n");
 343                 return NULL;
 344         }
 345
 346         return &nacl->se_node_acl;
 347 }
 348
 349 static void tcm_qla2xxx_release_fabric_acl(
 350         struct se_portal_group *se_tpg,
 351         struct se_node_acl *se_nacl)
 352 {
 353         struct tcm_qla2xxx_nacl *nacl = container_of(se_nacl,
 354                         struct tcm_qla2xxx_nacl, se_node_acl);
 355         kfree(nacl);
 356 }
 357
 358 static u32 tcm_qla2xxx_tpg_get_inst_index(struct se_portal_group *se_tpg)
 359 {
 360         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 361                                 struct tcm_qla2xxx_tpg, se_tpg);
 362
 363         return tpg->lport_tpgt;
 364 }
 365
 366 static void tcm_qla2xxx_complete_mcmd(struct work_struct *work)
 367 {
 368         struct qla_tgt_mgmt_cmd *mcmd = container_of(work,
 369                         struct qla_tgt_mgmt_cmd, free_work);
 370
 371         transport_generic_free_cmd(&mcmd->se_cmd, 0);
 372 }
 373
 374 /*
 375  * Called from qla_target_template->free_mcmd(), and will call
 376  * tcm_qla2xxx_release_cmd() via normal struct target_core_fabric_ops
 377  * release callback.  qla_hw_data->hardware_lock is expected to be held
 378  */
 379 static void tcm_qla2xxx_free_mcmd(struct qla_tgt_mgmt_cmd *mcmd)
 380 {
 381         INIT_WORK(&mcmd->free_work, tcm_qla2xxx_complete_mcmd);
 382         queue_work(tcm_qla2xxx_free_wq, &mcmd->free_work);
 383 }
 384
 385 static void tcm_qla2xxx_complete_free(struct work_struct *work)
 386 {
 387         struct qla_tgt_cmd *cmd = container_of(work, struct qla_tgt_cmd, work);
 388
 389         transport_generic_free_cmd(&cmd->se_cmd, 0);
 390 }
 391
 392 /*
 393  * Called from qla_target_template->free_cmd(), and will call
 394  * tcm_qla2xxx_release_cmd via normal struct target_core_fabric_ops
 395  * release callback.  qla_hw_data->hardware_lock is expected to be held
 396  */
 397 static void tcm_qla2xxx_free_cmd(struct qla_tgt_cmd *cmd)
 398 {
 399         INIT_WORK(&cmd->work, tcm_qla2xxx_complete_free);
 400         queue_work(tcm_qla2xxx_free_wq, &cmd->work);
 401 }
 402
 403 /*
 404  * Called from struct target_core_fabric_ops->check_stop_free() context
 405  */
 406 static int tcm_qla2xxx_check_stop_free(struct se_cmd *se_cmd)
 407 {
 408         return target_put_sess_cmd(se_cmd->se_sess, se_cmd);
 409 }
 410
 411 /* tcm_qla2xxx_release_cmd - Callback from TCM Core to release underlying
 412  * fabric descriptor @se_cmd command to release
 413  */
 414 static void tcm_qla2xxx_release_cmd(struct se_cmd *se_cmd)
 415 {
 416         struct qla_tgt_cmd *cmd;
 417
 418         if (se_cmd->se_cmd_flags & SCF_SCSI_TMR_CDB) {
 419                 struct qla_tgt_mgmt_cmd *mcmd = container_of(se_cmd,
 420                                 struct qla_tgt_mgmt_cmd, se_cmd);
 421                 qlt_free_mcmd(mcmd);
 422                 return;
 423         }
 424
 425         cmd = container_of(se_cmd, struct qla_tgt_cmd, se_cmd);
 426         qlt_free_cmd(cmd);
 427 }
 428
 429 static int tcm_qla2xxx_shutdown_session(struct se_session *se_sess)
 430 {
 431         struct qla_tgt_sess *sess = se_sess->fabric_sess_ptr;
 432         struct scsi_qla_host *vha;
 433         unsigned long flags;
 434
 435         BUG_ON(!sess);
 436         vha = sess->vha;
 437
 438         spin_lock_irqsave(&vha->hw->hardware_lock, flags);
 439         target_sess_cmd_list_set_waiting(se_sess);
 440         spin_unlock_irqrestore(&vha->hw->hardware_lock, flags);
 441
 442         return 1;
 443 }
 444
 445 static void tcm_qla2xxx_close_session(struct se_session *se_sess)
 446 {
 447         struct qla_tgt_sess *sess = se_sess->fabric_sess_ptr;
 448         struct scsi_qla_host *vha;
 449         unsigned long flags;
 450
 451         BUG_ON(!sess);
 452         vha = sess->vha;
 453
 454         spin_lock_irqsave(&vha->hw->hardware_lock, flags);
 455         qlt_unreg_sess(sess);
 456         spin_unlock_irqrestore(&vha->hw->hardware_lock, flags);
 457 }
 458
 459 static u32 tcm_qla2xxx_sess_get_index(struct se_session *se_sess)
 460 {
 461         return 0;
 462 }
 463
 464 static int tcm_qla2xxx_write_pending(struct se_cmd *se_cmd)
 465 {
 466         struct qla_tgt_cmd *cmd = container_of(se_cmd,
 467                                 struct qla_tgt_cmd, se_cmd);
 468
 469         cmd->bufflen = se_cmd->data_length;
 470         cmd->dma_data_direction = target_reverse_dma_direction(se_cmd);
 471
 472         cmd->sg_cnt = se_cmd->t_data_nents;
 473         cmd->sg = se_cmd->t_data_sg;
 474
 475         /*
 476          * qla_target.c:qlt_rdy_to_xfer() will call pci_map_sg() to setup
 477          * the SGL mappings into PCIe memory for incoming FCP WRITE data.
 478          */
 479         return qlt_rdy_to_xfer(cmd);
 480 }
 481
 482 static int tcm_qla2xxx_write_pending_status(struct se_cmd *se_cmd)
 483 {
 484         unsigned long flags;
 485         /*
 486          * Check for WRITE_PENDING status to determine if we need to wait for
 487          * CTIO aborts to be posted via hardware in tcm_qla2xxx_handle_data().
 488          */
 489         spin_lock_irqsave(&se_cmd->t_state_lock, flags);
 490         if (se_cmd->t_state == TRANSPORT_WRITE_PENDING ||
 491             se_cmd->t_state == TRANSPORT_COMPLETE_QF_WP) {
 492                 spin_unlock_irqrestore(&se_cmd->t_state_lock, flags);
 493                 wait_for_completion_timeout(&se_cmd->t_transport_stop_comp,
 494                                                 3000);
 495                 return 0;
 496         }
 497         spin_unlock_irqrestore(&se_cmd->t_state_lock, flags);
 498
 499         return 0;
 500 }
 501
 502 static void tcm_qla2xxx_set_default_node_attrs(struct se_node_acl *nacl)
 503 {
 504         return;
 505 }
 506
 507 static u32 tcm_qla2xxx_get_task_tag(struct se_cmd *se_cmd)
 508 {
 509         struct qla_tgt_cmd *cmd = container_of(se_cmd,
 510                                 struct qla_tgt_cmd, se_cmd);
 511
 512         return cmd->tag;
 513 }
 514
 515 static int tcm_qla2xxx_get_cmd_state(struct se_cmd *se_cmd)
 516 {
 517         return 0;
 518 }
 519
 520 /*
 521  * Called from process context in qla_target.c:qlt_do_work() code
 522  */
 523 static int tcm_qla2xxx_handle_cmd(scsi_qla_host_t *vha, struct qla_tgt_cmd *cmd,
 524         unsigned char *cdb, uint32_t data_length, int fcp_task_attr,
 525         int data_dir, int bidi)
 526 {
 527         struct se_cmd *se_cmd = &cmd->se_cmd;
 528         struct se_session *se_sess;
 529         struct qla_tgt_sess *sess;
 530         int flags = TARGET_SCF_ACK_KREF;
 531
 532         if (bidi)
 533                 flags |= TARGET_SCF_BIDI_OP;
 534
 535         sess = cmd->sess;
 536         if (!sess) {
 537                 pr_err("Unable to locate struct qla_tgt_sess from qla_tgt_cmd\n");
 538                 return -EINVAL;
 539         }
 540
 541         se_sess = sess->se_sess;
 542         if (!se_sess) {
 543                 pr_err("Unable to locate active struct se_session\n");
 544                 return -EINVAL;
 545         }
 546
 547         return target_submit_cmd(se_cmd, se_sess, cdb, &cmd->sense_buffer[0],
 548                                 cmd->unpacked_lun, data_length, fcp_task_attr,
 549                                 data_dir, flags);
 550 }
 551
 552 static void tcm_qla2xxx_handle_data_work(struct work_struct *work)
 553 {
 554         struct qla_tgt_cmd *cmd = container_of(work, struct qla_tgt_cmd, work);
 555
 556         /*
 557          * Ensure that the complete FCP WRITE payload has been received.
 558          * Otherwise return an exception via CHECK_CONDITION status.
 559          */
 560         if (!cmd->write_data_transferred) {
 561                 /*
 562                  * Check if se_cmd has already been aborted via LUN_RESET, and
 563                  * waiting upon completion in tcm_qla2xxx_write_pending_status()
 564                  */
 565                 if (cmd->se_cmd.transport_state & CMD_T_ABORTED) {
 566                         complete(&cmd->se_cmd.t_transport_stop_comp);
 567                         return;
 568                 }
 569
 570                 transport_generic_request_failure(&cmd->se_cmd,
 571                                                   TCM_CHECK_CONDITION_ABORT_CMD);
 572                 return;
 573         }
 574
 575         return target_execute_cmd(&cmd->se_cmd);
 576 }
 577
 578 /*
 579  * Called from qla_target.c:qlt_do_ctio_completion()
 580  */
 581 static void tcm_qla2xxx_handle_data(struct qla_tgt_cmd *cmd)
 582 {
 583         INIT_WORK(&cmd->work, tcm_qla2xxx_handle_data_work);
 584         queue_work(tcm_qla2xxx_free_wq, &cmd->work);
 585 }
 586
 587 /*
 588  * Called from qla_target.c:qlt_issue_task_mgmt()
 589  */
 590 static int tcm_qla2xxx_handle_tmr(struct qla_tgt_mgmt_cmd *mcmd, uint32_t lun,
 591         uint8_t tmr_func, uint32_t tag)
 592 {
 593         struct qla_tgt_sess *sess = mcmd->sess;
 594         struct se_cmd *se_cmd = &mcmd->se_cmd;
 595
 596         return target_submit_tmr(se_cmd, sess->se_sess, NULL, lun, mcmd,
 597                         tmr_func, GFP_ATOMIC, tag, TARGET_SCF_ACK_KREF);
 598 }
 599
 600 static int tcm_qla2xxx_queue_data_in(struct se_cmd *se_cmd)
 601 {
 602         struct qla_tgt_cmd *cmd = container_of(se_cmd,
 603                                 struct qla_tgt_cmd, se_cmd);
 604
 605         cmd->bufflen = se_cmd->data_length;
 606         cmd->dma_data_direction = target_reverse_dma_direction(se_cmd);
 607         cmd->aborted = (se_cmd->transport_state & CMD_T_ABORTED);
 608
 609         cmd->sg_cnt = se_cmd->t_data_nents;
 610         cmd->sg = se_cmd->t_data_sg;
 611         cmd->offset = 0;
 612
 613         /*
 614          * Now queue completed DATA_IN the qla2xxx LLD and response ring
 615          */
 616         return qlt_xmit_response(cmd, QLA_TGT_XMIT_DATA|QLA_TGT_XMIT_STATUS,
 617                                 se_cmd->scsi_status);
 618 }
 619
 620 static int tcm_qla2xxx_queue_status(struct se_cmd *se_cmd)
 621 {
 622         struct qla_tgt_cmd *cmd = container_of(se_cmd,
 623                                 struct qla_tgt_cmd, se_cmd);
 624         int xmit_type = QLA_TGT_XMIT_STATUS;
 625
 626         cmd->bufflen = se_cmd->data_length;
 627         cmd->sg = NULL;
 628         cmd->sg_cnt = 0;
 629         cmd->offset = 0;
 630         cmd->dma_data_direction = target_reverse_dma_direction(se_cmd);
 631         cmd->aborted = (se_cmd->transport_state & CMD_T_ABORTED);
 632
 633         if (se_cmd->data_direction == DMA_FROM_DEVICE) {
 634                 /*
 635                  * For FCP_READ with CHECK_CONDITION status, clear cmd->bufflen
 636                  * for qla_tgt_xmit_response LLD code
 637                  */
 638                 if (se_cmd->se_cmd_flags & SCF_OVERFLOW_BIT) {
 639                         se_cmd->se_cmd_flags &= ~SCF_OVERFLOW_BIT;
 640                         se_cmd->residual_count = 0;
 641                 }
 642                 se_cmd->se_cmd_flags |= SCF_UNDERFLOW_BIT;
 643                 se_cmd->residual_count += se_cmd->data_length;
 644
 645                 cmd->bufflen = 0;
 646         }
 647         /*
 648          * Now queue status response to qla2xxx LLD code and response ring
 649          */
 650         return qlt_xmit_response(cmd, xmit_type, se_cmd->scsi_status);
 651 }
 652
 653 static void tcm_qla2xxx_queue_tm_rsp(struct se_cmd *se_cmd)
 654 {
 655         struct se_tmr_req *se_tmr = se_cmd->se_tmr_req;
 656         struct qla_tgt_mgmt_cmd *mcmd = container_of(se_cmd,
 657                                 struct qla_tgt_mgmt_cmd, se_cmd);
 658
 659         pr_debug("queue_tm_rsp: mcmd: %p func: 0x%02x response: 0x%02x\n",
 660                         mcmd, se_tmr->function, se_tmr->response);
 661         /*
 662          * Do translation between TCM TM response codes and
 663          * QLA2xxx FC TM response codes.
 664          */
 665         switch (se_tmr->response) {
 666         case TMR_FUNCTION_COMPLETE:
 667                 mcmd->fc_tm_rsp = FC_TM_SUCCESS;
 668                 break;
 669         case TMR_TASK_DOES_NOT_EXIST:
 670                 mcmd->fc_tm_rsp = FC_TM_BAD_CMD;
 671                 break;
 672         case TMR_FUNCTION_REJECTED:
 673                 mcmd->fc_tm_rsp = FC_TM_REJECT;
 674                 break;
 675         case TMR_LUN_DOES_NOT_EXIST:
 676         default:
 677                 mcmd->fc_tm_rsp = FC_TM_FAILED;
 678                 break;
 679         }
 680         /*
 681          * Queue the TM response to QLA2xxx LLD to build a
 682          * CTIO response packet.
 683          */
 684         qlt_xmit_tm_rsp(mcmd);
 685 }
 686
 687 static void tcm_qla2xxx_aborted_task(struct se_cmd *se_cmd)
 688 {
 689         struct qla_tgt_cmd *cmd = container_of(se_cmd,
 690                                 struct qla_tgt_cmd, se_cmd);
 691         struct scsi_qla_host *vha = cmd->vha;
 692         struct qla_hw_data *ha = vha->hw;
 693
 694         if (!cmd->sg_mapped)
 695                 return;
 696
 697         pci_unmap_sg(ha->pdev, cmd->sg, cmd->sg_cnt, cmd->dma_data_direction);
 698         cmd->sg_mapped = 0;
 699 }
 700
 701 /* Local pointer to allocated TCM configfs fabric module */
 702 struct target_fabric_configfs *tcm_qla2xxx_fabric_configfs;
 703 struct target_fabric_configfs *tcm_qla2xxx_npiv_fabric_configfs;
 704
 705 static void tcm_qla2xxx_clear_sess_lookup(struct tcm_qla2xxx_lport *,
 706                         struct tcm_qla2xxx_nacl *, struct qla_tgt_sess *);
 707 /*
 708  * Expected to be called with struct qla_hw_data->hardware_lock held
 709  */
 710 static void tcm_qla2xxx_clear_nacl_from_fcport_map(struct qla_tgt_sess *sess)
 711 {
 712         struct se_node_acl *se_nacl = sess->se_sess->se_node_acl;
 713         struct se_portal_group *se_tpg = se_nacl->se_tpg;
 714         struct se_wwn *se_wwn = se_tpg->se_tpg_wwn;
 715         struct tcm_qla2xxx_lport *lport = container_of(se_wwn,
 716                                 struct tcm_qla2xxx_lport, lport_wwn);
 717         struct tcm_qla2xxx_nacl *nacl = container_of(se_nacl,
 718                                 struct tcm_qla2xxx_nacl, se_node_acl);
 719         void *node;
 720
 721         pr_debug("fc_rport domain: port_id 0x%06x\n", nacl->nport_id);
 722
 723         node = btree_remove32(&lport->lport_fcport_map, nacl->nport_id);
 724         WARN_ON(node && (node != se_nacl));
 725
 726         pr_debug("Removed from fcport_map: %p for WWNN: 0x%016LX, port_id: 0x%06x\n",
 727             se_nacl, nacl->nport_wwnn, nacl->nport_id);
 728         /*
 729          * Now clear the se_nacl and session pointers from our HW lport lookup
 730          * table mapping for this initiator's fabric S_ID and LOOP_ID entries.
 731          *
 732          * This is done ahead of callbacks into tcm_qla2xxx_free_session() ->
 733          * target_wait_for_sess_cmds() before the session waits for outstanding
 734          * I/O to complete, to avoid a race between session shutdown execution
 735          * and incoming ATIOs or TMRs picking up a stale se_node_act reference.
 736          */
 737         tcm_qla2xxx_clear_sess_lookup(lport, nacl, sess);
 738 }
 739
 740 static void tcm_qla2xxx_release_session(struct kref *kref)
 741 {
 742         struct se_session *se_sess = container_of(kref,
 743                         struct se_session, sess_kref);
 744
 745         qlt_unreg_sess(se_sess->fabric_sess_ptr);
 746 }
 747
 748 static void tcm_qla2xxx_put_session(struct se_session *se_sess)
 749 {
 750         struct qla_tgt_sess *sess = se_sess->fabric_sess_ptr;
 751         struct qla_hw_data *ha = sess->vha->hw;
 752         unsigned long flags;
 753
 754         spin_lock_irqsave(&ha->hardware_lock, flags);
 755         kref_put(&se_sess->sess_kref, tcm_qla2xxx_release_session);
 756         spin_unlock_irqrestore(&ha->hardware_lock, flags);
 757 }
 758
 759 static void tcm_qla2xxx_put_sess(struct qla_tgt_sess *sess)
 760 {
 761         if (!sess)
 762                 return;
 763
 764         assert_spin_locked(&sess->vha->hw->hardware_lock);
 765         kref_put(&sess->se_sess->sess_kref, tcm_qla2xxx_release_session);
 766 }
 767
 768 static void tcm_qla2xxx_shutdown_sess(struct qla_tgt_sess *sess)
 769 {
 770         assert_spin_locked(&sess->vha->hw->hardware_lock);
 771         target_sess_cmd_list_set_waiting(sess->se_sess);
 772 }
 773
 774 static struct se_node_acl *tcm_qla2xxx_make_nodeacl(
 775         struct se_portal_group *se_tpg,
 776         struct config_group *group,
 777         const char *name)
 778 {
 779         struct se_node_acl *se_nacl, *se_nacl_new;
 780         struct tcm_qla2xxx_nacl *nacl;
 781         u64 wwnn;
 782         u32 qla2xxx_nexus_depth;
 783
 784         if (tcm_qla2xxx_parse_wwn(name, &wwnn, 1) < 0)
 785                 return ERR_PTR(-EINVAL);
 786
 787         se_nacl_new = tcm_qla2xxx_alloc_fabric_acl(se_tpg);
 788         if (!se_nacl_new)
 789                 return ERR_PTR(-ENOMEM);
 790 /* #warning FIXME: Hardcoded qla2xxx_nexus depth in tcm_qla2xxx_make_nodeacl */
 791         qla2xxx_nexus_depth = 1;
 792
 793         /*
 794          * se_nacl_new may be released by core_tpg_add_initiator_node_acl()
 795          * when converting a NodeACL from demo mode -> explict
 796          */
 797         se_nacl = core_tpg_add_initiator_node_acl(se_tpg, se_nacl_new,
 798                                 name, qla2xxx_nexus_depth);
 799         if (IS_ERR(se_nacl)) {
 800                 tcm_qla2xxx_release_fabric_acl(se_tpg, se_nacl_new);
 801                 return se_nacl;
 802         }
 803         /*
 804          * Locate our struct tcm_qla2xxx_nacl and set the FC Nport WWPN
 805          */
 806         nacl = container_of(se_nacl, struct tcm_qla2xxx_nacl, se_node_acl);
 807         nacl->nport_wwnn = wwnn;
 808         tcm_qla2xxx_format_wwn(&nacl->nport_name[0], TCM_QLA2XXX_NAMELEN, wwnn);
 809
 810         return se_nacl;
 811 }
 812
 813 static void tcm_qla2xxx_drop_nodeacl(struct se_node_acl *se_acl)
 814 {
 815         struct se_portal_group *se_tpg = se_acl->se_tpg;
 816         struct tcm_qla2xxx_nacl *nacl = container_of(se_acl,
 817                                 struct tcm_qla2xxx_nacl, se_node_acl);
 818
 819         core_tpg_del_initiator_node_acl(se_tpg, se_acl, 1);
 820         kfree(nacl);
 821 }
 822
 823 /* Start items for tcm_qla2xxx_tpg_attrib_cit */
 824
 825 #define DEF_QLA_TPG_ATTRIB(name)                                        \
 826                                                                         \
 827 static ssize_t tcm_qla2xxx_tpg_attrib_show_##name(                      \
 828         struct se_portal_group *se_tpg,                                 \
 829         char *page)                                                     \
 830 {                                                                       \
 831         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,              \
 832                         struct tcm_qla2xxx_tpg, se_tpg);                \
 833                                                                         \
 834         return sprintf(page, "%u\n", tpg->tpg_attrib.name);     \
 835 }                                                                       \
 836                                                                         \
 837 static ssize_t tcm_qla2xxx_tpg_attrib_store_##name(                     \
 838         struct se_portal_group *se_tpg,                                 \
 839         const char *page,                                               \
 840         size_t count)                                                   \
 841 {                                                                       \
 842         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,              \
 843                         struct tcm_qla2xxx_tpg, se_tpg);                \
 844         unsigned long val;                                              \
 845         int ret;                                                        \
 846                                                                         \
 847         ret = kstrtoul(page, 0, &val);                                  \
 848         if (ret < 0) {                                                  \
 849                 pr_err("kstrtoul() failed with"                         \
 850                                 " ret: %d\n", ret);                     \
 851                 return -EINVAL;                                         \
 852         }                                                               \
 853         ret = tcm_qla2xxx_set_attrib_##name(tpg, val);                  \
 854                                                                         \
 855         return (!ret) ? count : -EINVAL;                                \
 856 }
 857
 858 #define DEF_QLA_TPG_ATTR_BOOL(_name)                                    \
 859                                                                         \
 860 static int tcm_qla2xxx_set_attrib_##_name(                              \
 861         struct tcm_qla2xxx_tpg *tpg,                                    \
 862         unsigned long val)                                              \
 863 {                                                                       \
 864         struct tcm_qla2xxx_tpg_attrib *a = &tpg->tpg_attrib;            \
 865                                                                         \
 866         if ((val != 0) && (val != 1)) {                                 \
 867                 pr_err("Illegal boolean value %lu\n", val);             \
 868                 return -EINVAL;                                         \
 869         }                                                               \
 870                                                                         \
 871         a->_name = val;                                                 \
 872         return 0;                                                       \
 873 }
 874
 875 #define QLA_TPG_ATTR(_name, _mode) \
 876         TF_TPG_ATTRIB_ATTR(tcm_qla2xxx, _name, _mode);
 877
 878 /*
 879  * Define tcm_qla2xxx_tpg_attrib_s_generate_node_acls
 880  */
 881 DEF_QLA_TPG_ATTR_BOOL(generate_node_acls);
 882 DEF_QLA_TPG_ATTRIB(generate_node_acls);
 883 QLA_TPG_ATTR(generate_node_acls, S_IRUGO | S_IWUSR);
 884
 885 /*
 886  Define tcm_qla2xxx_attrib_s_cache_dynamic_acls
 887  */
 888 DEF_QLA_TPG_ATTR_BOOL(cache_dynamic_acls);
 889 DEF_QLA_TPG_ATTRIB(cache_dynamic_acls);
 890 QLA_TPG_ATTR(cache_dynamic_acls, S_IRUGO | S_IWUSR);
 891
 892 /*
 893  * Define tcm_qla2xxx_tpg_attrib_s_demo_mode_write_protect
 894  */
 895 DEF_QLA_TPG_ATTR_BOOL(demo_mode_write_protect);
 896 DEF_QLA_TPG_ATTRIB(demo_mode_write_protect);
 897 QLA_TPG_ATTR(demo_mode_write_protect, S_IRUGO | S_IWUSR);
 898
 899 /*
 900  * Define tcm_qla2xxx_tpg_attrib_s_prod_mode_write_protect
 901  */
 902 DEF_QLA_TPG_ATTR_BOOL(prod_mode_write_protect);
 903 DEF_QLA_TPG_ATTRIB(prod_mode_write_protect);
 904 QLA_TPG_ATTR(prod_mode_write_protect, S_IRUGO | S_IWUSR);
 905
 906 /*
 907  * Define tcm_qla2xxx_tpg_attrib_s_demo_mode_login_only
 908  */
 909 DEF_QLA_TPG_ATTR_BOOL(demo_mode_login_only);
 910 DEF_QLA_TPG_ATTRIB(demo_mode_login_only);
 911 QLA_TPG_ATTR(demo_mode_login_only, S_IRUGO | S_IWUSR);
 912
 913 static struct configfs_attribute *tcm_qla2xxx_tpg_attrib_attrs[] = {
 914         &tcm_qla2xxx_tpg_attrib_generate_node_acls.attr,
 915         &tcm_qla2xxx_tpg_attrib_cache_dynamic_acls.attr,
 916         &tcm_qla2xxx_tpg_attrib_demo_mode_write_protect.attr,
 917         &tcm_qla2xxx_tpg_attrib_prod_mode_write_protect.attr,
 918         &tcm_qla2xxx_tpg_attrib_demo_mode_login_only.attr,
 919         NULL,
 920 };
 921
 922 /* End items for tcm_qla2xxx_tpg_attrib_cit */
 923
 924 static ssize_t tcm_qla2xxx_tpg_show_enable(
 925         struct se_portal_group *se_tpg,
 926         char *page)
 927 {
 928         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 929                         struct tcm_qla2xxx_tpg, se_tpg);
 930
 931         return snprintf(page, PAGE_SIZE, "%d\n",
 932                         atomic_read(&tpg->lport_tpg_enabled));
 933 }
 934
 935 static void tcm_qla2xxx_depend_tpg(struct work_struct *work)
 936 {
 937         struct tcm_qla2xxx_tpg *base_tpg = container_of(work,
 938                                 struct tcm_qla2xxx_tpg, tpg_base_work);
 939         struct se_portal_group *se_tpg = &base_tpg->se_tpg;
 940         struct scsi_qla_host *base_vha = base_tpg->lport->qla_vha;
 941
 942         if (!configfs_depend_item(se_tpg->se_tpg_tfo->tf_subsys,
 943                                   &se_tpg->tpg_group.cg_item)) {
 944                 atomic_set(&base_tpg->lport_tpg_enabled, 1);
 945                 qlt_enable_vha(base_vha);
 946         }
 947         complete(&base_tpg->tpg_base_comp);
 948 }
 949
 950 static void tcm_qla2xxx_undepend_tpg(struct work_struct *work)
 951 {
 952         struct tcm_qla2xxx_tpg *base_tpg = container_of(work,
 953                                 struct tcm_qla2xxx_tpg, tpg_base_work);
 954         struct se_portal_group *se_tpg = &base_tpg->se_tpg;
 955         struct scsi_qla_host *base_vha = base_tpg->lport->qla_vha;
 956
 957         if (!qlt_stop_phase1(base_vha->vha_tgt.qla_tgt)) {
 958                 atomic_set(&base_tpg->lport_tpg_enabled, 0);
 959                 configfs_undepend_item(se_tpg->se_tpg_tfo->tf_subsys,
 960                                        &se_tpg->tpg_group.cg_item);
 961         }
 962         complete(&base_tpg->tpg_base_comp);
 963 }
 964
 965 static ssize_t tcm_qla2xxx_tpg_store_enable(
 966         struct se_portal_group *se_tpg,
 967         const char *page,
 968         size_t count)
 969 {
 970         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
 971                         struct tcm_qla2xxx_tpg, se_tpg);
 972         unsigned long op;
 973         int rc;
 974
 975         rc = kstrtoul(page, 0, &op);
 976         if (rc < 0) {
 977                 pr_err("kstrtoul() returned %d\n", rc);
 978                 return -EINVAL;
 979         }
 980         if ((op != 1) && (op != 0)) {
 981                 pr_err("Illegal value for tpg_enable: %lu\n", op);
 982                 return -EINVAL;
 983         }
 984         if (op) {
 985                 if (atomic_read(&tpg->lport_tpg_enabled))
 986                         return -EEXIST;
 987
 988                 INIT_WORK(&tpg->tpg_base_work, tcm_qla2xxx_depend_tpg);
 989         } else {
 990                 if (!atomic_read(&tpg->lport_tpg_enabled))
 991                         return count;
 992
 993                 INIT_WORK(&tpg->tpg_base_work, tcm_qla2xxx_undepend_tpg);
 994         }
 995         init_completion(&tpg->tpg_base_comp);
 996         schedule_work(&tpg->tpg_base_work);
 997         wait_for_completion(&tpg->tpg_base_comp);
 998
 999         if (op) {
1000                 if (!atomic_read(&tpg->lport_tpg_enabled))
1001                         return -ENODEV;
1002         } else {
1003                 if (atomic_read(&tpg->lport_tpg_enabled))
1004                         return -EPERM;
1005         }
1006         return count;
1007 }
1008
1009 TF_TPG_BASE_ATTR(tcm_qla2xxx, enable, S_IRUGO | S_IWUSR);
1010
1011 static struct configfs_attribute *tcm_qla2xxx_tpg_attrs[] = {
1012         &tcm_qla2xxx_tpg_enable.attr,
1013         NULL,
1014 };
1015
1016 static struct se_portal_group *tcm_qla2xxx_make_tpg(
1017         struct se_wwn *wwn,
1018         struct config_group *group,
1019         const char *name)
1020 {
1021         struct tcm_qla2xxx_lport *lport = container_of(wwn,
1022                         struct tcm_qla2xxx_lport, lport_wwn);
1023         struct tcm_qla2xxx_tpg *tpg;
1024         unsigned long tpgt;
1025         int ret;
1026
1027         if (strstr(name, "tpgt_") != name)
1028                 return ERR_PTR(-EINVAL);
1029         if (kstrtoul(name + 5, 10, &tpgt) || tpgt > USHRT_MAX)
1030                 return ERR_PTR(-EINVAL);
1031
1032         if ((tpgt != 1)) {
1033                 pr_err("In non NPIV mode, a single TPG=1 is used for HW port mappings\n");
1034                 return ERR_PTR(-ENOSYS);
1035         }
1036
1037         tpg = kzalloc(sizeof(struct tcm_qla2xxx_tpg), GFP_KERNEL);
1038         if (!tpg) {
1039                 pr_err("Unable to allocate struct tcm_qla2xxx_tpg\n");
1040                 return ERR_PTR(-ENOMEM);
1041         }
1042         tpg->lport = lport;
1043         tpg->lport_tpgt = tpgt;
1044         /*
1045          * By default allow READ-ONLY TPG demo-mode access w/ cached dynamic
1046          * NodeACLs
1047          */
1048         tpg->tpg_attrib.generate_node_acls = 1;
1049         tpg->tpg_attrib.demo_mode_write_protect = 1;
1050         tpg->tpg_attrib.cache_dynamic_acls = 1;
1051         tpg->tpg_attrib.demo_mode_login_only = 1;
1052
1053         ret = core_tpg_register(&tcm_qla2xxx_fabric_configfs->tf_ops, wwn,
1054                                 &tpg->se_tpg, tpg, TRANSPORT_TPG_TYPE_NORMAL);
1055         if (ret < 0) {
1056                 kfree(tpg);
1057                 return NULL;
1058         }
1059
1060         lport->tpg_1 = tpg;
1061
1062         return &tpg->se_tpg;
1063 }
1064
1065 static void tcm_qla2xxx_drop_tpg(struct se_portal_group *se_tpg)
1066 {
1067         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
1068                         struct tcm_qla2xxx_tpg, se_tpg);
1069         struct tcm_qla2xxx_lport *lport = tpg->lport;
1070         struct scsi_qla_host *vha = lport->qla_vha;
1071         /*
1072          * Call into qla2x_target.c LLD logic to shutdown the active
1073          * FC Nexuses and disable target mode operation for this qla_hw_data
1074          */
1075         if (vha->vha_tgt.qla_tgt && !vha->vha_tgt.qla_tgt->tgt_stop)
1076                 qlt_stop_phase1(vha->vha_tgt.qla_tgt);
1077
1078         core_tpg_deregister(se_tpg);
1079         /*
1080          * Clear local TPG=1 pointer for non NPIV mode.
1081          */
1082         lport->tpg_1 = NULL;
1083         kfree(tpg);
1084 }
1085
1086 static ssize_t tcm_qla2xxx_npiv_tpg_show_enable(
1087         struct se_portal_group *se_tpg,
1088         char *page)
1089 {
1090         return tcm_qla2xxx_tpg_show_enable(se_tpg, page);
1091 }
1092
1093 static ssize_t tcm_qla2xxx_npiv_tpg_store_enable(
1094         struct se_portal_group *se_tpg,
1095         const char *page,
1096         size_t count)
1097 {
1098         struct se_wwn *se_wwn = se_tpg->se_tpg_wwn;
1099         struct tcm_qla2xxx_lport *lport = container_of(se_wwn,
1100                         struct tcm_qla2xxx_lport, lport_wwn);
1101         struct scsi_qla_host *vha = lport->qla_vha;
1102         struct tcm_qla2xxx_tpg *tpg = container_of(se_tpg,
1103                         struct tcm_qla2xxx_tpg, se_tpg);
1104         unsigned long op;
1105         int rc;
1106
1107         rc = kstrtoul(page, 0, &op);
1108         if (rc < 0) {
1109                 pr_err("kstrtoul() returned %d\n", rc);
1110                 return -EINVAL;
1111         }
1112         if ((op != 1) && (op != 0)) {
1113                 pr_err("Illegal value for tpg_enable: %lu\n", op);
1114                 return -EINVAL;
1115         }
1116         if (op) {
1117                 if (atomic_read(&tpg->lport_tpg_enabled))
1118                         return -EEXIST;
1119
1120                 atomic_set(&tpg->lport_tpg_enabled, 1);
1121                 qlt_enable_vha(vha);
1122         } else {
1123                 if (!atomic_read(&tpg->lport_tpg_enabled))
1124                         return count;
1125
1126                 atomic_set(&tpg->lport_tpg_enabled, 0);
1127                 qlt_stop_phase1(vha->vha_tgt.qla_tgt);
1128         }
1129
1130         return count;
1131 }
1132
1133 TF_TPG_BASE_ATTR(tcm_qla2xxx_npiv, enable, S_IRUGO | S_IWUSR);
1134
1135 static struct configfs_attribute *tcm_qla2xxx_npiv_tpg_attrs[] = {
1136         &tcm_qla2xxx_npiv_tpg_enable.attr,
1137         NULL,
1138 };
1139
1140 static struct se_portal_group *tcm_qla2xxx_npiv_make_tpg(
1141         struct se_wwn *wwn,
1142         struct config_group *group,
1143         const char *name)
1144 {
1145         struct tcm_qla2xxx_lport *lport = container_of(wwn,
1146                         struct tcm_qla2xxx_lport, lport_wwn);
1147         struct tcm_qla2xxx_tpg *tpg;
1148         unsigned long tpgt;
1149         int ret;
1150
1151         if (strstr(name, "tpgt_") != name)
1152                 return ERR_PTR(-EINVAL);
1153         if (kstrtoul(name + 5, 10, &tpgt) || tpgt > USHRT_MAX)
1154                 return ERR_PTR(-EINVAL);
1155
1156         tpg = kzalloc(sizeof(struct tcm_qla2xxx_tpg), GFP_KERNEL);
1157         if (!tpg) {
1158                 pr_err("Unable to allocate struct tcm_qla2xxx_tpg\n");
1159                 return ERR_PTR(-ENOMEM);
1160         }
1161         tpg->lport = lport;
1162         tpg->lport_tpgt = tpgt;
1163
1164         /*
1165          * By default allow READ-ONLY TPG demo-mode access w/ cached dynamic
1166          * NodeACLs
1167          */
1168         tpg->tpg_attrib.generate_node_acls = 1;
1169         tpg->tpg_attrib.demo_mode_write_protect = 1;
1170         tpg->tpg_attrib.cache_dynamic_acls = 1;
1171         tpg->tpg_attrib.demo_mode_login_only = 1;
1172
1173         ret = core_tpg_register(&tcm_qla2xxx_npiv_fabric_configfs->tf_ops, wwn,
1174                                 &tpg->se_tpg, tpg, TRANSPORT_TPG_TYPE_NORMAL);
1175         if (ret < 0) {
1176                 kfree(tpg);
1177                 return NULL;
1178         }
1179         lport->tpg_1 = tpg;
1180         return &tpg->se_tpg;
1181 }
1182
1183 /*
1184  * Expected to be called with struct qla_hw_data->hardware_lock held
1185  */
1186 static struct qla_tgt_sess *tcm_qla2xxx_find_sess_by_s_id(
1187         scsi_qla_host_t *vha,
1188         const uint8_t *s_id)
1189 {
1190         struct tcm_qla2xxx_lport *lport;
1191         struct se_node_acl *se_nacl;
1192         struct tcm_qla2xxx_nacl *nacl;
1193         u32 key;
1194
1195         lport = vha->vha_tgt.target_lport_ptr;
1196         if (!lport) {
1197                 pr_err("Unable to locate struct tcm_qla2xxx_lport\n");
1198                 dump_stack();
1199                 return NULL;
1200         }
1201
1202         key = (((unsigned long)s_id[0] << 16) |
1203                ((unsigned long)s_id[1] << 8) |
1204                (unsigned long)s_id[2]);
1205         pr_debug("find_sess_by_s_id: 0x%06x\n", key);
1206
1207         se_nacl = btree_lookup32(&lport->lport_fcport_map, key);
1208         if (!se_nacl) {
1209                 pr_debug("Unable to locate s_id: 0x%06x\n", key);
1210                 return NULL;
1211         }
1212         pr_debug("find_sess_by_s_id: located se_nacl: %p, initiatorname: %s\n",
1213             se_nacl, se_nacl->initiatorname);
1214
1215         nacl = container_of(se_nacl, struct tcm_qla2xxx_nacl, se_node_acl);
1216         if (!nacl->qla_tgt_sess) {
1217                 pr_err("Unable to locate struct qla_tgt_sess\n");
1218                 return NULL;
1219         }
1220
1221         return nacl->qla_tgt_sess;
1222 }
1223
1224 /*
1225  * Expected to be called with struct qla_hw_data->hardware_lock held
1226  */
1227 static void tcm_qla2xxx_set_sess_by_s_id(
1228         struct tcm_qla2xxx_lport *lport,
1229         struct se_node_acl *new_se_nacl,
1230         struct tcm_qla2xxx_nacl *nacl,
1231         struct se_session *se_sess,
1232         struct qla_tgt_sess *qla_tgt_sess,
1233         uint8_t *s_id)
1234 {
1235         u32 key;
1236         void *slot;
1237         int rc;
1238
1239         key = (((unsigned long)s_id[0] << 16) |
1240                ((unsigned long)s_id[1] << 8) |
1241                (unsigned long)s_id[2]);
1242         pr_debug("set_sess_by_s_id: %06x\n", key);
1243
1244         slot = btree_lookup32(&lport->lport_fcport_map, key);
1245         if (!slot) {
1246                 if (new_se_nacl) {
1247                         pr_debug("Setting up new fc_port entry to new_se_nacl\n");
1248                         nacl->nport_id = key;
1249                         rc = btree_insert32(&lport->lport_fcport_map, key,
1250                                         new_se_nacl, GFP_ATOMIC);
1251                         if (rc)
1252                                 printk(KERN_ERR "Unable to insert s_id into fcport_map: %06x\n",
1253                                     (int)key);
1254                 } else {
1255                         pr_debug("Wiping nonexisting fc_port entry\n");
1256                 }
1257
1258                 qla_tgt_sess->se_sess = se_sess;
1259                 nacl->qla_tgt_sess = qla_tgt_sess;
1260                 return;
1261         }
1262
1263         if (nacl->qla_tgt_sess) {
1264                 if (new_se_nacl == NULL) {
1265                         pr_debug("Clearing existing nacl->qla_tgt_sess and fc_port entry\n");
1266                         btree_remove32(&lport->lport_fcport_map, key);
1267                         nacl->qla_tgt_sess = NULL;
1268                         return;
1269                 }
1270                 pr_debug("Replacing existing nacl->qla_tgt_sess and fc_port entry\n");
1271                 btree_update32(&lport->lport_fcport_map, key, new_se_nacl);
1272                 qla_tgt_sess->se_sess = se_sess;
1273                 nacl->qla_tgt_sess = qla_tgt_sess;
1274                 return;
1275         }
1276
1277         if (new_se_nacl == NULL) {
1278                 pr_debug("Clearing existing fc_port entry\n");
1279                 btree_remove32(&lport->lport_fcport_map, key);
1280                 return;
1281         }
1282
1283         pr_debug("Replacing existing fc_port entry w/o active nacl->qla_tgt_sess\n");
1284         btree_update32(&lport->lport_fcport_map, key, new_se_nacl);
1285         qla_tgt_sess->se_sess = se_sess;
1286         nacl->qla_tgt_sess = qla_tgt_sess;
1287
1288         pr_debug("Setup nacl->qla_tgt_sess %p by s_id for se_nacl: %p, initiatorname: %s\n",
1289             nacl->qla_tgt_sess, new_se_nacl, new_se_nacl->initiatorname);
1290 }
1291
1292 /*
1293  * Expected to be called with struct qla_hw_data->hardware_lock held
1294  */
1295 static struct qla_tgt_sess *tcm_qla2xxx_find_sess_by_loop_id(
1296         scsi_qla_host_t *vha,
1297         const uint16_t loop_id)
1298 {
1299         struct tcm_qla2xxx_lport *lport;
1300         struct se_node_acl *se_nacl;
1301         struct tcm_qla2xxx_nacl *nacl;
1302         struct tcm_qla2xxx_fc_loopid *fc_loopid;
1303
1304         lport = vha->vha_tgt.target_lport_ptr;
1305         if (!lport) {
1306                 pr_err("Unable to locate struct tcm_qla2xxx_lport\n");
1307                 dump_stack();
1308                 return NULL;
1309         }
1310
1311         pr_debug("find_sess_by_loop_id: Using loop_id: 0x%04x\n", loop_id);
1312
1313         fc_loopid = lport->lport_loopid_map + loop_id;
1314         se_nacl = fc_loopid->se_nacl;
1315         if (!se_nacl) {
1316                 pr_debug("Unable to locate se_nacl by loop_id: 0x%04x\n",
1317                     loop_id);
1318                 return NULL;
1319         }
1320
1321         nacl = container_of(se_nacl, struct tcm_qla2xxx_nacl, se_node_acl);
1322
1323         if (!nacl->qla_tgt_sess) {
1324                 pr_err("Unable to locate struct qla_tgt_sess\n");
1325                 return NULL;
1326         }
1327
1328         return nacl->qla_tgt_sess;
1329 }
1330
1331 /*
1332  * Expected to be called with struct qla_hw_data->hardware_lock held
1333  */
1334 static void tcm_qla2xxx_set_sess_by_loop_id(
1335         struct tcm_qla2xxx_lport *lport,
1336         struct se_node_acl *new_se_nacl,
1337         struct tcm_qla2xxx_nacl *nacl,
1338         struct se_session *se_sess,
1339         struct qla_tgt_sess *qla_tgt_sess,
1340         uint16_t loop_id)
1341 {
1342         struct se_node_acl *saved_nacl;
1343         struct tcm_qla2xxx_fc_loopid *fc_loopid;
1344
1345         pr_debug("set_sess_by_loop_id: Using loop_id: 0x%04x\n", loop_id);
1346
1347         fc_loopid = &((struct tcm_qla2xxx_fc_loopid *)
1348                         lport->lport_loopid_map)[loop_id];
1349
1350         saved_nacl = fc_loopid->se_nacl;
1351         if (!saved_nacl) {
1352                 pr_debug("Setting up new fc_loopid->se_nacl to new_se_nacl\n");
1353                 fc_loopid->se_nacl = new_se_nacl;
1354                 if (qla_tgt_sess->se_sess != se_sess)
1355                         qla_tgt_sess->se_sess = se_sess;
1356                 if (nacl->qla_tgt_sess != qla_tgt_sess)
1357                         nacl->qla_tgt_sess = qla_tgt_sess;
1358                 return;
1359         }
1360
1361         if (nacl->qla_tgt_sess) {
1362                 if (new_se_nacl == NULL) {
1363                         pr_debug("Clearing nacl->qla_tgt_sess and fc_loopid->se_nacl\n");
1364                         fc_loopid->se_nacl = NULL;
1365                         nacl->qla_tgt_sess = NULL;
1366                         return;
1367                 }
1368
1369                 pr_debug("Replacing existing nacl->qla_tgt_sess and fc_loopid->se_nacl\n");
1370                 fc_loopid->se_nacl = new_se_nacl;
1371                 if (qla_tgt_sess->se_sess != se_sess)
1372                         qla_tgt_sess->se_sess = se_sess;
1373                 if (nacl->qla_tgt_sess != qla_tgt_sess)
1374                         nacl->qla_tgt_sess = qla_tgt_sess;
1375                 return;
1376         }
1377
1378         if (new_se_nacl == NULL) {
1379                 pr_debug("Clearing fc_loopid->se_nacl\n");
1380                 fc_loopid->se_nacl = NULL;
1381                 return;
1382         }
1383
1384         pr_debug("Replacing existing fc_loopid->se_nacl w/o active nacl->qla_tgt_sess\n");
1385         fc_loopid->se_nacl = new_se_nacl;
1386         if (qla_tgt_sess->se_sess != se_sess)
1387                 qla_tgt_sess->se_sess = se_sess;
1388         if (nacl->qla_tgt_sess != qla_tgt_sess)
1389                 nacl->qla_tgt_sess = qla_tgt_sess;
1390
1391         pr_debug("Setup nacl->qla_tgt_sess %p by loop_id for se_nacl: %p, initiatorname: %s\n",
1392             nacl->qla_tgt_sess, new_se_nacl, new_se_nacl->initiatorname);
1393 }
1394
1395 /*
1396  * Should always be called with qla_hw_data->hardware_lock held.
1397  */
1398 static void tcm_qla2xxx_clear_sess_lookup(struct tcm_qla2xxx_lport *lport,
1399                 struct tcm_qla2xxx_nacl *nacl, struct qla_tgt_sess *sess)
1400 {
1401         struct se_session *se_sess = sess->se_sess;
1402         unsigned char be_sid[3];
1403
1404         be_sid[0] = sess->s_id.b.domain;
1405         be_sid[1] = sess->s_id.b.area;
1406         be_sid[2] = sess->s_id.b.al_pa;
1407
1408         tcm_qla2xxx_set_sess_by_s_id(lport, NULL, nacl, se_sess,
1409                                 sess, be_sid);
1410         tcm_qla2xxx_set_sess_by_loop_id(lport, NULL, nacl, se_sess,
1411                                 sess, sess->loop_id);
1412 }
1413
1414 static void tcm_qla2xxx_free_session(struct qla_tgt_sess *sess)
1415 {
1416         struct qla_tgt *tgt = sess->tgt;
1417         struct qla_hw_data *ha = tgt->ha;
1418         scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev);
1419         struct se_session *se_sess;
1420         struct se_node_acl *se_nacl;
1421         struct tcm_qla2xxx_lport *lport;
1422         struct tcm_qla2xxx_nacl *nacl;
1423
1424         BUG_ON(in_interrupt());
1425
1426         se_sess = sess->se_sess;
1427         if (!se_sess) {
1428                 pr_err("struct qla_tgt_sess->se_sess is NULL\n");
1429                 dump_stack();
1430                 return;
1431         }
1432         se_nacl = se_sess->se_node_acl;
1433         nacl = container_of(se_nacl, struct tcm_qla2xxx_nacl, se_node_acl);
1434
1435         lport = vha->vha_tgt.target_lport_ptr;
1436         if (!lport) {
1437                 pr_err("Unable to locate struct tcm_qla2xxx_lport\n");
1438                 dump_stack();
1439                 return;
1440         }
1441         target_wait_for_sess_cmds(se_sess);
1442
1443         transport_deregister_session_configfs(sess->se_sess);
1444         transport_deregister_session(sess->se_sess);
1445 }
1446
1447 /*
1448  * Called via qlt_create_sess():ha->qla2x_tmpl->check_initiator_node_acl()
1449  * to locate struct se_node_acl
1450  */
1451 static int tcm_qla2xxx_check_initiator_node_acl(
1452         scsi_qla_host_t *vha,
1453         unsigned char *fc_wwpn,
1454         void *qla_tgt_sess,
1455         uint8_t *s_id,
1456         uint16_t loop_id)
1457 {
1458         struct qla_hw_data *ha = vha->hw;
1459         struct tcm_qla2xxx_lport *lport;
1460         struct tcm_qla2xxx_tpg *tpg;
1461         struct tcm_qla2xxx_nacl *nacl;
1462         struct se_portal_group *se_tpg;
1463         struct se_node_acl *se_nacl;
1464         struct se_session *se_sess;
1465         struct qla_tgt_sess *sess = qla_tgt_sess;
1466         unsigned char port_name[36];
1467         unsigned long flags;
1468
1469         lport = vha->vha_tgt.target_lport_ptr;
1470         if (!lport) {
1471                 pr_err("Unable to locate struct tcm_qla2xxx_lport\n");
1472                 dump_stack();
1473                 return -EINVAL;
1474         }
1475         /*
1476          * Locate the TPG=1 reference..
1477          */
1478         tpg = lport->tpg_1;
1479         if (!tpg) {
1480                 pr_err("Unable to lcoate struct tcm_qla2xxx_lport->tpg_1\n");
1481                 return -EINVAL;
1482         }
1483         se_tpg = &tpg->se_tpg;
1484
1485         se_sess = transport_init_session(TARGET_PROT_NORMAL);
1486         if (IS_ERR(se_sess)) {
1487                 pr_err("Unable to initialize struct se_session\n");
1488                 return PTR_ERR(se_sess);
1489         }
1490         /*
1491          * Format the FCP Initiator port_name into colon seperated values to
1492          * match the format by tcm_qla2xxx explict ConfigFS NodeACLs.
1493          */
1494         memset(&port_name, 0, 36);
1495         snprintf(port_name, 36, "%02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x",
1496                 fc_wwpn[0], fc_wwpn[1], fc_wwpn[2], fc_wwpn[3], fc_wwpn[4],
1497                 fc_wwpn[5], fc_wwpn[6], fc_wwpn[7]);
1498         /*
1499          * Locate our struct se_node_acl either from an explict NodeACL created
1500          * via ConfigFS, or via running in TPG demo mode.
1501          */
1502         se_sess->se_node_acl = core_tpg_check_initiator_node_acl(se_tpg,
1503                                         port_name);
1504         if (!se_sess->se_node_acl) {
1505                 transport_free_session(se_sess);
1506                 return -EINVAL;
1507         }
1508         se_nacl = se_sess->se_node_acl;
1509         nacl = container_of(se_nacl, struct tcm_qla2xxx_nacl, se_node_acl);
1510         /*
1511          * And now setup the new se_nacl and session pointers into our HW lport
1512          * mappings for fabric S_ID and LOOP_ID.
1513          */
1514         spin_lock_irqsave(&ha->hardware_lock, flags);
1515         tcm_qla2xxx_set_sess_by_s_id(lport, se_nacl, nacl, se_sess,
1516                         qla_tgt_sess, s_id);
1517         tcm_qla2xxx_set_sess_by_loop_id(lport, se_nacl, nacl, se_sess,
1518                         qla_tgt_sess, loop_id);
1519         spin_unlock_irqrestore(&ha->hardware_lock, flags);
1520         /*
1521          * Finally register the new FC Nexus with TCM
1522          */
1523         __transport_register_session(se_nacl->se_tpg, se_nacl, se_sess, sess);
1524
1525         return 0;
1526 }
1527
1528 static void tcm_qla2xxx_update_sess(struct qla_tgt_sess *sess, port_id_t s_id,
1529                                     uint16_t loop_id, bool conf_compl_supported)
1530 {
1531         struct qla_tgt *tgt = sess->tgt;
1532         struct qla_hw_data *ha = tgt->ha;
1533         scsi_qla_host_t *vha = pci_get_drvdata(ha->pdev);
1534         struct tcm_qla2xxx_lport *lport = vha->vha_tgt.target_lport_ptr;
1535         struct se_node_acl *se_nacl = sess->se_sess->se_node_acl;
1536         struct tcm_qla2xxx_nacl *nacl = container_of(se_nacl,
1537                         struct tcm_qla2xxx_nacl, se_node_acl);
1538         u32 key;
1539
1540
1541         if (sess->loop_id != loop_id || sess->s_id.b24 != s_id.b24)
1542                 pr_info("Updating session %p from port %8phC loop_id %d -> %d s_id %x:%x:%x -> %x:%x:%x\n",
1543                     sess, sess->port_name,
1544                     sess->loop_id, loop_id, sess->s_id.b.domain,
1545                     sess->s_id.b.area, sess->s_id.b.al_pa, s_id.b.domain,
1546                     s_id.b.area, s_id.b.al_pa);
1547
1548         if (sess->loop_id != loop_id) {
1549                 /*
1550                  * Because we can shuffle loop IDs around and we
1551                  * update different sessions non-atomically, we might
1552                  * have overwritten this session's old loop ID
1553                  * already, and we might end up overwriting some other
1554                  * session that will be updated later.  So we have to
1555                  * be extra careful and we can't warn about those things...
1556                  */
1557                 if (lport->lport_loopid_map[sess->loop_id].se_nacl == se_nacl)
1558                         lport->lport_loopid_map[sess->loop_id].se_nacl = NULL;
1559
1560                 lport->lport_loopid_map[loop_id].se_nacl = se_nacl;
1561
1562                 sess->loop_id = loop_id;
1563         }
1564
1565         if (sess->s_id.b24 != s_id.b24) {
1566                 key = (((u32) sess->s_id.b.domain << 16) |
1567                        ((u32) sess->s_id.b.area   <<  8) |
1568                        ((u32) sess->s_id.b.al_pa));
1569
1570                 if (btree_lookup32(&lport->lport_fcport_map, key))
1571                         WARN(btree_remove32(&lport->lport_fcport_map, key) != se_nacl,
1572                              "Found wrong se_nacl when updating s_id %x:%x:%x\n",
1573                              sess->s_id.b.domain, sess->s_id.b.area, sess->s_id.b.al_pa);
1574                 else
1575                         WARN(1, "No lport_fcport_map entry for s_id %x:%x:%x\n",
1576                              sess->s_id.b.domain, sess->s_id.b.area, sess->s_id.b.al_pa);
1577
1578                 key = (((u32) s_id.b.domain << 16) |
1579                        ((u32) s_id.b.area   <<  8) |
1580                        ((u32) s_id.b.al_pa));
1581
1582                 if (btree_lookup32(&lport->lport_fcport_map, key)) {
1583                         WARN(1, "Already have lport_fcport_map entry for s_id %x:%x:%x\n",
1584                              s_id.b.domain, s_id.b.area, s_id.b.al_pa);
1585                         btree_update32(&lport->lport_fcport_map, key, se_nacl);
1586                 } else {
1587                         btree_insert32(&lport->lport_fcport_map, key, se_nacl, GFP_ATOMIC);
1588                 }
1589
1590                 sess->s_id = s_id;
1591                 nacl->nport_id = key;
1592         }
1593
1594         sess->conf_compl_supported = conf_compl_supported;
1595 }
1596
1597 /*
1598  * Calls into tcm_qla2xxx used by qla2xxx LLD I/O path.
1599  */
1600 static struct qla_tgt_func_tmpl tcm_qla2xxx_template = {
1601         .handle_cmd             = tcm_qla2xxx_handle_cmd,
1602         .handle_data            = tcm_qla2xxx_handle_data,
1603         .handle_tmr             = tcm_qla2xxx_handle_tmr,
1604         .free_cmd               = tcm_qla2xxx_free_cmd,
1605         .free_mcmd              = tcm_qla2xxx_free_mcmd,
1606         .free_session           = tcm_qla2xxx_free_session,
1607         .update_sess            = tcm_qla2xxx_update_sess,
1608         .check_initiator_node_acl = tcm_qla2xxx_check_initiator_node_acl,
1609         .find_sess_by_s_id      = tcm_qla2xxx_find_sess_by_s_id,
1610         .find_sess_by_loop_id   = tcm_qla2xxx_find_sess_by_loop_id,
1611         .clear_nacl_from_fcport_map = tcm_qla2xxx_clear_nacl_from_fcport_map,
1612         .put_sess               = tcm_qla2xxx_put_sess,
1613         .shutdown_sess          = tcm_qla2xxx_shutdown_sess,
1614 };
1615
1616 static int tcm_qla2xxx_init_lport(struct tcm_qla2xxx_lport *lport)
1617 {
1618         int rc;
1619
1620         rc = btree_init32(&lport->lport_fcport_map);
1621         if (rc) {
1622                 pr_err("Unable to initialize lport->lport_fcport_map btree\n");
1623                 return rc;
1624         }
1625
1626         lport->lport_loopid_map = vmalloc(sizeof(struct tcm_qla2xxx_fc_loopid) *
1627                                 65536);
1628         if (!lport->lport_loopid_map) {
1629                 pr_err("Unable to allocate lport->lport_loopid_map of %zu bytes\n",
1630                     sizeof(struct tcm_qla2xxx_fc_loopid) * 65536);
1631                 btree_destroy32(&lport->lport_fcport_map);
1632                 return -ENOMEM;
1633         }
1634         memset(lport->lport_loopid_map, 0, sizeof(struct tcm_qla2xxx_fc_loopid)
1635                * 65536);
1636         pr_debug("qla2xxx: Allocated lport_loopid_map of %zu bytes\n",
1637                sizeof(struct tcm_qla2xxx_fc_loopid) * 65536);
1638         return 0;
1639 }
1640
1641 static int tcm_qla2xxx_lport_register_cb(struct scsi_qla_host *vha,
1642                                          void *target_lport_ptr,
1643                                          u64 npiv_wwpn, u64 npiv_wwnn)
1644 {
1645         struct qla_hw_data *ha = vha->hw;
1646         struct tcm_qla2xxx_lport *lport =
1647                         (struct tcm_qla2xxx_lport *)target_lport_ptr;
1648         /*
1649          * Setup tgt_ops, local pointer to vha and target_lport_ptr
1650          */
1651         ha->tgt.tgt_ops = &tcm_qla2xxx_template;
1652         vha->vha_tgt.target_lport_ptr = target_lport_ptr;
1653         lport->qla_vha = vha;
1654
1655         return 0;
1656 }
1657
1658 static struct se_wwn *tcm_qla2xxx_make_lport(
1659         struct target_fabric_configfs *tf,
1660         struct config_group *group,
1661         const char *name)
1662 {
1663         struct tcm_qla2xxx_lport *lport;
1664         u64 wwpn;
1665         int ret = -ENODEV;
1666
1667         if (tcm_qla2xxx_parse_wwn(name, &wwpn, 1) < 0)
1668                 return ERR_PTR(-EINVAL);
1669
1670         lport = kzalloc(sizeof(struct tcm_qla2xxx_lport), GFP_KERNEL);
1671         if (!lport) {
1672                 pr_err("Unable to allocate struct tcm_qla2xxx_lport\n");
1673                 return ERR_PTR(-ENOMEM);
1674         }
1675         lport->lport_wwpn = wwpn;
1676         tcm_qla2xxx_format_wwn(&lport->lport_name[0], TCM_QLA2XXX_NAMELEN,
1677                                 wwpn);
1678         sprintf(lport->lport_naa_name, "naa.%016llx", (unsigned long long) wwpn);
1679
1680         ret = tcm_qla2xxx_init_lport(lport);
1681         if (ret != 0)
1682                 goto out;
1683
1684         ret = qlt_lport_register(lport, wwpn, 0, 0,
1685                                  tcm_qla2xxx_lport_register_cb);
1686         if (ret != 0)
1687                 goto out_lport;
1688
1689         return &lport->lport_wwn;
1690 out_lport:
1691         vfree(lport->lport_loopid_map);
1692         btree_destroy32(&lport->lport_fcport_map);
1693 out:
1694         kfree(lport);
1695         return ERR_PTR(ret);
1696 }
1697
1698 static void tcm_qla2xxx_drop_lport(struct se_wwn *wwn)
1699 {
1700         struct tcm_qla2xxx_lport *lport = container_of(wwn,
1701                         struct tcm_qla2xxx_lport, lport_wwn);
1702         struct scsi_qla_host *vha = lport->qla_vha;
1703         struct se_node_acl *node;
1704         u32 key = 0;
1705
1706         /*
1707          * Call into qla2x_target.c LLD logic to complete the
1708          * shutdown of struct qla_tgt after the call to
1709          * qlt_stop_phase1() from tcm_qla2xxx_drop_tpg() above..
1710          */
1711         if (vha->vha_tgt.qla_tgt && !vha->vha_tgt.qla_tgt->tgt_stopped)
1712                 qlt_stop_phase2(vha->vha_tgt.qla_tgt);
1713
1714         qlt_lport_deregister(vha);
1715
1716         vfree(lport->lport_loopid_map);
1717         btree_for_each_safe32(&lport->lport_fcport_map, key, node)
1718                 btree_remove32(&lport->lport_fcport_map, key);
1719         btree_destroy32(&lport->lport_fcport_map);
1720         kfree(lport);
1721 }
1722
1723 static int tcm_qla2xxx_lport_register_npiv_cb(struct scsi_qla_host *base_vha,
1724                                               void *target_lport_ptr,
1725                                               u64 npiv_wwpn, u64 npiv_wwnn)
1726 {
1727         struct fc_vport *vport;
1728         struct Scsi_Host *sh = base_vha->host;
1729         struct scsi_qla_host *npiv_vha;
1730         struct tcm_qla2xxx_lport *lport =
1731                         (struct tcm_qla2xxx_lport *)target_lport_ptr;
1732         struct tcm_qla2xxx_lport *base_lport =
1733                         (struct tcm_qla2xxx_lport *)base_vha->vha_tgt.target_lport_ptr;
1734         struct tcm_qla2xxx_tpg *base_tpg;
1735         struct fc_vport_identifiers vport_id;
1736
1737         if (!qla_tgt_mode_enabled(base_vha)) {
1738                 pr_err("qla2xxx base_vha not enabled for target mode\n");
1739                 return -EPERM;
1740         }
1741
1742         if (!base_lport || !base_lport->tpg_1 ||
1743             !atomic_read(&base_lport->tpg_1->lport_tpg_enabled)) {
1744                 pr_err("qla2xxx base_lport or tpg_1 not available\n");
1745                 return -EPERM;
1746         }
1747         base_tpg = base_lport->tpg_1;
1748
1749         memset(&vport_id, 0, sizeof(vport_id));
1750         vport_id.port_name = npiv_wwpn;
1751         vport_id.node_name = npiv_wwnn;
1752         vport_id.roles = FC_PORT_ROLE_FCP_INITIATOR;
1753         vport_id.vport_type = FC_PORTTYPE_NPIV;
1754         vport_id.disable = false;
1755
1756         vport = fc_vport_create(sh, 0, &vport_id);
1757         if (!vport) {
1758                 pr_err("fc_vport_create failed for qla2xxx_npiv\n");
1759                 return -ENODEV;
1760         }
1761         /*
1762          * Setup local pointer to NPIV vhba + target_lport_ptr
1763          */
1764         npiv_vha = (struct scsi_qla_host *)vport->dd_data;
1765         npiv_vha->vha_tgt.target_lport_ptr = target_lport_ptr;
1766         lport->qla_vha = npiv_vha;
1767         scsi_host_get(npiv_vha->host);
1768         return 0;
1769 }
1770
1771
1772 static struct se_wwn *tcm_qla2xxx_npiv_make_lport(
1773         struct target_fabric_configfs *tf,
1774         struct config_group *group,
1775         const char *name)
1776 {
1777         struct tcm_qla2xxx_lport *lport;
1778         u64 phys_wwpn, npiv_wwpn, npiv_wwnn;
1779         char *p, tmp[128];
1780         int ret;
1781
1782         snprintf(tmp, 128, "%s", name);
1783
1784         p = strchr(tmp, '@');
1785         if (!p) {
1786                 pr_err("Unable to locate NPIV '@' seperator\n");
1787                 return ERR_PTR(-EINVAL);
1788         }
1789         *p++ = '\0';
1790
1791         if (tcm_qla2xxx_parse_wwn(tmp, &phys_wwpn, 1) < 0)
1792                 return ERR_PTR(-EINVAL);
1793
1794         if (tcm_qla2xxx_npiv_parse_wwn(p, strlen(p)+1,
1795                                        &npiv_wwpn, &npiv_wwnn) < 0)
1796                 return ERR_PTR(-EINVAL);
1797
1798         lport = kzalloc(sizeof(struct tcm_qla2xxx_lport), GFP_KERNEL);
1799         if (!lport) {
1800                 pr_err("Unable to allocate struct tcm_qla2xxx_lport for NPIV\n");
1801                 return ERR_PTR(-ENOMEM);
1802         }
1803         lport->lport_npiv_wwpn = npiv_wwpn;
1804         lport->lport_npiv_wwnn = npiv_wwnn;
1805         sprintf(lport->lport_naa_name, "naa.%016llx", (unsigned long long) npiv_wwpn);
1806
1807         ret = tcm_qla2xxx_init_lport(lport);
1808         if (ret != 0)
1809                 goto out;
1810
1811         ret = qlt_lport_register(lport, phys_wwpn, npiv_wwpn, npiv_wwnn,
1812                                  tcm_qla2xxx_lport_register_npiv_cb);
1813         if (ret != 0)
1814                 goto out_lport;
1815
1816         return &lport->lport_wwn;
1817 out_lport:
1818         vfree(lport->lport_loopid_map);
1819         btree_destroy32(&lport->lport_fcport_map);
1820 out:
1821         kfree(lport);
1822         return ERR_PTR(ret);
1823 }
1824
1825 static void tcm_qla2xxx_npiv_drop_lport(struct se_wwn *wwn)
1826 {
1827         struct tcm_qla2xxx_lport *lport = container_of(wwn,
1828                         struct tcm_qla2xxx_lport, lport_wwn);
1829         struct scsi_qla_host *npiv_vha = lport->qla_vha;
1830         struct qla_hw_data *ha = npiv_vha->hw;
1831         scsi_qla_host_t *base_vha = pci_get_drvdata(ha->pdev);
1832
1833         scsi_host_put(npiv_vha->host);
1834         /*
1835          * Notify libfc that we want to release the vha->fc_vport
1836          */
1837         fc_vport_terminate(npiv_vha->fc_vport);
1838         scsi_host_put(base_vha->host);
1839         kfree(lport);
1840 }
1841
1842
1843 static ssize_t tcm_qla2xxx_wwn_show_attr_version(
1844         struct target_fabric_configfs *tf,
1845         char *page)
1846 {
1847         return sprintf(page,
1848             "TCM QLOGIC QLA2XXX NPIV capable fabric module %s on %s/%s on "
1849             UTS_RELEASE"\n", TCM_QLA2XXX_VERSION, utsname()->sysname,
1850             utsname()->machine);
1851 }
1852
1853 TF_WWN_ATTR_RO(tcm_qla2xxx, version);
1854
1855 static struct configfs_attribute *tcm_qla2xxx_wwn_attrs[] = {
1856         &tcm_qla2xxx_wwn_version.attr,
1857         NULL,
1858 };
1859
1860 static struct target_core_fabric_ops tcm_qla2xxx_ops = {
1861         .get_fabric_name                = tcm_qla2xxx_get_fabric_name,
1862         .get_fabric_proto_ident         = tcm_qla2xxx_get_fabric_proto_ident,
1863         .tpg_get_wwn                    = tcm_qla2xxx_get_fabric_wwn,
1864         .tpg_get_tag                    = tcm_qla2xxx_get_tag,
1865         .tpg_get_default_depth          = tcm_qla2xxx_get_default_depth,
1866         .tpg_get_pr_transport_id        = tcm_qla2xxx_get_pr_transport_id,
1867         .tpg_get_pr_transport_id_len    = tcm_qla2xxx_get_pr_transport_id_len,
1868         .tpg_parse_pr_out_transport_id  = tcm_qla2xxx_parse_pr_out_transport_id,
1869         .tpg_check_demo_mode            = tcm_qla2xxx_check_demo_mode,
1870         .tpg_check_demo_mode_cache      = tcm_qla2xxx_check_demo_mode_cache,
1871         .tpg_check_demo_mode_write_protect =
1872                                         tcm_qla2xxx_check_demo_write_protect,
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_alloc_fabric_acl           = tcm_qla2xxx_alloc_fabric_acl,
1877         .tpg_release_fabric_acl         = tcm_qla2xxx_release_fabric_acl,
1878         .tpg_get_inst_index             = tcm_qla2xxx_tpg_get_inst_index,
1879         .check_stop_free                = tcm_qla2xxx_check_stop_free,
1880         .release_cmd                    = tcm_qla2xxx_release_cmd,
1881         .put_session                    = tcm_qla2xxx_put_session,
1882         .shutdown_session               = tcm_qla2xxx_shutdown_session,
1883         .close_session                  = tcm_qla2xxx_close_session,
1884         .sess_get_index                 = tcm_qla2xxx_sess_get_index,
1885         .sess_get_initiator_sid         = NULL,
1886         .write_pending                  = tcm_qla2xxx_write_pending,
1887         .write_pending_status           = tcm_qla2xxx_write_pending_status,
1888         .set_default_node_attributes    = tcm_qla2xxx_set_default_node_attrs,
1889         .get_task_tag                   = tcm_qla2xxx_get_task_tag,
1890         .get_cmd_state                  = tcm_qla2xxx_get_cmd_state,
1891         .queue_data_in                  = tcm_qla2xxx_queue_data_in,
1892         .queue_status                   = tcm_qla2xxx_queue_status,
1893         .queue_tm_rsp                   = tcm_qla2xxx_queue_tm_rsp,
1894         .aborted_task                   = tcm_qla2xxx_aborted_task,
1895         /*
1896          * Setup function pointers for generic logic in
1897          * target_core_fabric_configfs.c
1898          */
1899         .fabric_make_wwn                = tcm_qla2xxx_make_lport,
1900         .fabric_drop_wwn                = tcm_qla2xxx_drop_lport,
1901         .fabric_make_tpg                = tcm_qla2xxx_make_tpg,
1902         .fabric_drop_tpg                = tcm_qla2xxx_drop_tpg,
1903         .fabric_post_link               = NULL,
1904         .fabric_pre_unlink              = NULL,
1905         .fabric_make_np                 = NULL,
1906         .fabric_drop_np                 = NULL,
1907         .fabric_make_nodeacl            = tcm_qla2xxx_make_nodeacl,
1908         .fabric_drop_nodeacl            = tcm_qla2xxx_drop_nodeacl,
1909 };
1910
1911 static struct target_core_fabric_ops tcm_qla2xxx_npiv_ops = {
1912         .get_fabric_name                = tcm_qla2xxx_npiv_get_fabric_name,
1913         .get_fabric_proto_ident         = tcm_qla2xxx_get_fabric_proto_ident,
1914         .tpg_get_wwn                    = tcm_qla2xxx_get_fabric_wwn,
1915         .tpg_get_tag                    = tcm_qla2xxx_get_tag,
1916         .tpg_get_default_depth          = tcm_qla2xxx_get_default_depth,
1917         .tpg_get_pr_transport_id        = tcm_qla2xxx_get_pr_transport_id,
1918         .tpg_get_pr_transport_id_len    = tcm_qla2xxx_get_pr_transport_id_len,
1919         .tpg_parse_pr_out_transport_id  = tcm_qla2xxx_parse_pr_out_transport_id,
1920         .tpg_check_demo_mode            = tcm_qla2xxx_check_demo_mode,
1921         .tpg_check_demo_mode_cache      = tcm_qla2xxx_check_demo_mode_cache,
1922         .tpg_check_demo_mode_write_protect = tcm_qla2xxx_check_demo_mode,
1923         .tpg_check_prod_mode_write_protect =
1924             tcm_qla2xxx_check_prod_write_protect,
1925         .tpg_check_demo_mode_login_only = tcm_qla2xxx_check_demo_mode_login_only,
1926         .tpg_alloc_fabric_acl           = tcm_qla2xxx_alloc_fabric_acl,
1927         .tpg_release_fabric_acl         = tcm_qla2xxx_release_fabric_acl,
1928         .tpg_get_inst_index             = tcm_qla2xxx_tpg_get_inst_index,
1929         .check_stop_free                = tcm_qla2xxx_check_stop_free,
1930         .release_cmd                    = tcm_qla2xxx_release_cmd,
1931         .put_session                    = tcm_qla2xxx_put_session,
1932         .shutdown_session               = tcm_qla2xxx_shutdown_session,
1933         .close_session                  = tcm_qla2xxx_close_session,
1934         .sess_get_index                 = tcm_qla2xxx_sess_get_index,
1935         .sess_get_initiator_sid         = NULL,
1936         .write_pending                  = tcm_qla2xxx_write_pending,
1937         .write_pending_status           = tcm_qla2xxx_write_pending_status,
1938         .set_default_node_attributes    = tcm_qla2xxx_set_default_node_attrs,
1939         .get_task_tag                   = tcm_qla2xxx_get_task_tag,
1940         .get_cmd_state                  = tcm_qla2xxx_get_cmd_state,
1941         .queue_data_in                  = tcm_qla2xxx_queue_data_in,
1942         .queue_status                   = tcm_qla2xxx_queue_status,
1943         .queue_tm_rsp                   = tcm_qla2xxx_queue_tm_rsp,
1944         .aborted_task                   = tcm_qla2xxx_aborted_task,
1945         /*
1946          * Setup function pointers for generic logic in
1947          * target_core_fabric_configfs.c
1948          */
1949         .fabric_make_wwn                = tcm_qla2xxx_npiv_make_lport,
1950         .fabric_drop_wwn                = tcm_qla2xxx_npiv_drop_lport,
1951         .fabric_make_tpg                = tcm_qla2xxx_npiv_make_tpg,
1952         .fabric_drop_tpg                = tcm_qla2xxx_drop_tpg,
1953         .fabric_post_link               = NULL,
1954         .fabric_pre_unlink              = NULL,
1955         .fabric_make_np                 = NULL,
1956         .fabric_drop_np                 = NULL,
1957         .fabric_make_nodeacl            = tcm_qla2xxx_make_nodeacl,
1958         .fabric_drop_nodeacl            = tcm_qla2xxx_drop_nodeacl,
1959 };
1960
1961 static int tcm_qla2xxx_register_configfs(void)
1962 {
1963         struct target_fabric_configfs *fabric, *npiv_fabric;
1964         int ret;
1965
1966         pr_debug("TCM QLOGIC QLA2XXX fabric module %s on %s/%s on "
1967             UTS_RELEASE"\n", TCM_QLA2XXX_VERSION, utsname()->sysname,
1968             utsname()->machine);
1969         /*
1970          * Register the top level struct config_item_type with TCM core
1971          */
1972         fabric = target_fabric_configfs_init(THIS_MODULE, "qla2xxx");
1973         if (IS_ERR(fabric)) {
1974                 pr_err("target_fabric_configfs_init() failed\n");
1975                 return PTR_ERR(fabric);
1976         }
1977         /*
1978          * Setup fabric->tf_ops from our local tcm_qla2xxx_ops
1979          */
1980         fabric->tf_ops = tcm_qla2xxx_ops;
1981         /*
1982          * Setup default attribute lists for various fabric->tf_cit_tmpl
1983          */
1984         fabric->tf_cit_tmpl.tfc_wwn_cit.ct_attrs = tcm_qla2xxx_wwn_attrs;
1985         fabric->tf_cit_tmpl.tfc_tpg_base_cit.ct_attrs = tcm_qla2xxx_tpg_attrs;
1986         fabric->tf_cit_tmpl.tfc_tpg_attrib_cit.ct_attrs =
1987                                                 tcm_qla2xxx_tpg_attrib_attrs;
1988         fabric->tf_cit_tmpl.tfc_tpg_param_cit.ct_attrs = NULL;
1989         fabric->tf_cit_tmpl.tfc_tpg_np_base_cit.ct_attrs = NULL;
1990         fabric->tf_cit_tmpl.tfc_tpg_nacl_base_cit.ct_attrs = NULL;
1991         fabric->tf_cit_tmpl.tfc_tpg_nacl_attrib_cit.ct_attrs = NULL;
1992         fabric->tf_cit_tmpl.tfc_tpg_nacl_auth_cit.ct_attrs = NULL;
1993         fabric->tf_cit_tmpl.tfc_tpg_nacl_param_cit.ct_attrs = NULL;
1994         /*
1995          * Register the fabric for use within TCM
1996          */
1997         ret = target_fabric_configfs_register(fabric);
1998         if (ret < 0) {
1999                 pr_err("target_fabric_configfs_register() failed for TCM_QLA2XXX\n");
2000                 return ret;
2001         }
2002         /*
2003          * Setup our local pointer to *fabric
2004          */
2005         tcm_qla2xxx_fabric_configfs = fabric;
2006         pr_debug("TCM_QLA2XXX[0] - Set fabric -> tcm_qla2xxx_fabric_configfs\n");
2007
2008         /*
2009          * Register the top level struct config_item_type for NPIV with TCM core
2010          */
2011         npiv_fabric = target_fabric_configfs_init(THIS_MODULE, "qla2xxx_npiv");
2012         if (IS_ERR(npiv_fabric)) {
2013                 pr_err("target_fabric_configfs_init() failed\n");
2014                 ret = PTR_ERR(npiv_fabric);
2015                 goto out_fabric;
2016         }
2017         /*
2018          * Setup fabric->tf_ops from our local tcm_qla2xxx_npiv_ops
2019          */
2020         npiv_fabric->tf_ops = tcm_qla2xxx_npiv_ops;
2021         /*
2022          * Setup default attribute lists for various npiv_fabric->tf_cit_tmpl
2023          */
2024         npiv_fabric->tf_cit_tmpl.tfc_wwn_cit.ct_attrs = tcm_qla2xxx_wwn_attrs;
2025         npiv_fabric->tf_cit_tmpl.tfc_tpg_base_cit.ct_attrs =
2026             tcm_qla2xxx_npiv_tpg_attrs;
2027         npiv_fabric->tf_cit_tmpl.tfc_tpg_attrib_cit.ct_attrs = NULL;
2028         npiv_fabric->tf_cit_tmpl.tfc_tpg_param_cit.ct_attrs = NULL;
2029         npiv_fabric->tf_cit_tmpl.tfc_tpg_np_base_cit.ct_attrs = NULL;
2030         npiv_fabric->tf_cit_tmpl.tfc_tpg_nacl_base_cit.ct_attrs = NULL;
2031         npiv_fabric->tf_cit_tmpl.tfc_tpg_nacl_attrib_cit.ct_attrs = NULL;
2032         npiv_fabric->tf_cit_tmpl.tfc_tpg_nacl_auth_cit.ct_attrs = NULL;
2033         npiv_fabric->tf_cit_tmpl.tfc_tpg_nacl_param_cit.ct_attrs = NULL;
2034         /*
2035          * Register the npiv_fabric for use within TCM
2036          */
2037         ret = target_fabric_configfs_register(npiv_fabric);
2038         if (ret < 0) {
2039                 pr_err("target_fabric_configfs_register() failed for TCM_QLA2XXX\n");
2040                 goto out_fabric;
2041         }
2042         /*
2043          * Setup our local pointer to *npiv_fabric
2044          */
2045         tcm_qla2xxx_npiv_fabric_configfs = npiv_fabric;
2046         pr_debug("TCM_QLA2XXX[0] - Set fabric -> tcm_qla2xxx_npiv_fabric_configfs\n");
2047
2048         tcm_qla2xxx_free_wq = alloc_workqueue("tcm_qla2xxx_free",
2049                                                 WQ_MEM_RECLAIM, 0);
2050         if (!tcm_qla2xxx_free_wq) {
2051                 ret = -ENOMEM;
2052                 goto out_fabric_npiv;
2053         }
2054
2055         tcm_qla2xxx_cmd_wq = alloc_workqueue("tcm_qla2xxx_cmd", 0, 0);
2056         if (!tcm_qla2xxx_cmd_wq) {
2057                 ret = -ENOMEM;
2058                 goto out_free_wq;
2059         }
2060
2061         return 0;
2062
2063 out_free_wq:
2064         destroy_workqueue(tcm_qla2xxx_free_wq);
2065 out_fabric_npiv:
2066         target_fabric_configfs_deregister(tcm_qla2xxx_npiv_fabric_configfs);
2067 out_fabric:
2068         target_fabric_configfs_deregister(tcm_qla2xxx_fabric_configfs);
2069         return ret;
2070 }
2071
2072 static void tcm_qla2xxx_deregister_configfs(void)
2073 {
2074         destroy_workqueue(tcm_qla2xxx_cmd_wq);
2075         destroy_workqueue(tcm_qla2xxx_free_wq);
2076
2077         target_fabric_configfs_deregister(tcm_qla2xxx_fabric_configfs);
2078         tcm_qla2xxx_fabric_configfs = NULL;
2079         pr_debug("TCM_QLA2XXX[0] - Cleared tcm_qla2xxx_fabric_configfs\n");
2080
2081         target_fabric_configfs_deregister(tcm_qla2xxx_npiv_fabric_configfs);
2082         tcm_qla2xxx_npiv_fabric_configfs = NULL;
2083         pr_debug("TCM_QLA2XXX[0] - Cleared tcm_qla2xxx_npiv_fabric_configfs\n");
2084 }
2085
2086 static int __init tcm_qla2xxx_init(void)
2087 {
2088         int ret;
2089
2090         ret = tcm_qla2xxx_register_configfs();
2091         if (ret < 0)
2092                 return ret;
2093
2094         return 0;
2095 }
2096
2097 static void __exit tcm_qla2xxx_exit(void)
2098 {
2099         tcm_qla2xxx_deregister_configfs();
2100 }
2101
2102 MODULE_DESCRIPTION("TCM QLA2XXX series NPIV enabled fabric driver");
2103 MODULE_LICENSE("GPL");
2104 module_init(tcm_qla2xxx_init);
2105 module_exit(tcm_qla2xxx_exit);