drivers/scsi/qla2xxx/tcm_qla2xxx.c

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