drivers/scsi/qla2xxx/tcm_qla2xxx.c

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