drivers/nvme/host/fc.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (c) 2016 Avago Technologies.  All rights reserved.
   4  */
   5 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
   6 #include <linux/module.h>
   7 #include <linux/parser.h>
   8 #include <uapi/scsi/fc/fc_fs.h>
   9 #include <uapi/scsi/fc/fc_els.h>
  10 #include <linux/delay.h>
  11 #include <linux/overflow.h>
  12
  13 #include "nvme.h"
  14 #include "fabrics.h"
  15 #include <linux/nvme-fc-driver.h>
  16 #include <linux/nvme-fc.h>
  17 #include "fc.h"
  18 #include <scsi/scsi_transport_fc.h>
  19
  20 /* *************************** Data Structures/Defines ****************** */
  21
  22
  23 enum nvme_fc_queue_flags {
  24         NVME_FC_Q_CONNECTED = 0,
  25         NVME_FC_Q_LIVE,
  26 };
  27
  28 #define NVME_FC_DEFAULT_DEV_LOSS_TMO    60      /* seconds */
  29 #define NVME_FC_DEFAULT_RECONNECT_TMO   2       /* delay between reconnects
  30                                                  * when connected and a
  31                                                  * connection failure.
  32                                                  */
  33
  34 struct nvme_fc_queue {
  35         struct nvme_fc_ctrl     *ctrl;
  36         struct device           *dev;
  37         struct blk_mq_hw_ctx    *hctx;
  38         void                    *lldd_handle;
  39         size_t                  cmnd_capsule_len;
  40         u32                     qnum;
  41         u32                     rqcnt;
  42         u32                     seqno;
  43
  44         u64                     connection_id;
  45         atomic_t                csn;
  46
  47         unsigned long           flags;
  48 } __aligned(sizeof(u64));       /* alignment for other things alloc'd with */
  49
  50 enum nvme_fcop_flags {
  51         FCOP_FLAGS_TERMIO       = (1 << 0),
  52         FCOP_FLAGS_AEN          = (1 << 1),
  53 };
  54
  55 struct nvmefc_ls_req_op {
  56         struct nvmefc_ls_req    ls_req;
  57
  58         struct nvme_fc_rport    *rport;
  59         struct nvme_fc_queue    *queue;
  60         struct request          *rq;
  61         u32                     flags;
  62
  63         int                     ls_error;
  64         struct completion       ls_done;
  65         struct list_head        lsreq_list;     /* rport->ls_req_list */
  66         bool                    req_queued;
  67 };
  68
  69 struct nvmefc_ls_rcv_op {
  70         struct nvme_fc_rport            *rport;
  71         struct nvmefc_ls_rsp            *lsrsp;
  72         union nvmefc_ls_requests        *rqstbuf;
  73         union nvmefc_ls_responses       *rspbuf;
  74         u16                             rqstdatalen;
  75         bool                            handled;
  76         dma_addr_t                      rspdma;
  77         struct list_head                lsrcv_list;     /* rport->ls_rcv_list */
  78 } __aligned(sizeof(u64));       /* alignment for other things alloc'd with */
  79
  80 enum nvme_fcpop_state {
  81         FCPOP_STATE_UNINIT      = 0,
  82         FCPOP_STATE_IDLE        = 1,
  83         FCPOP_STATE_ACTIVE      = 2,
  84         FCPOP_STATE_ABORTED     = 3,
  85         FCPOP_STATE_COMPLETE    = 4,
  86 };
  87
  88 struct nvme_fc_fcp_op {
  89         struct nvme_request     nreq;           /*
  90                                                  * nvme/host/core.c
  91                                                  * requires this to be
  92                                                  * the 1st element in the
  93                                                  * private structure
  94                                                  * associated with the
  95                                                  * request.
  96                                                  */
  97         struct nvmefc_fcp_req   fcp_req;
  98
  99         struct nvme_fc_ctrl     *ctrl;
 100         struct nvme_fc_queue    *queue;
 101         struct request          *rq;
 102
 103         atomic_t                state;
 104         u32                     flags;
 105         u32                     rqno;
 106         u32                     nents;
 107
 108         struct nvme_fc_cmd_iu   cmd_iu;
 109         struct nvme_fc_ersp_iu  rsp_iu;
 110 };
 111
 112 struct nvme_fcp_op_w_sgl {
 113         struct nvme_fc_fcp_op   op;
 114         struct scatterlist      sgl[NVME_INLINE_SG_CNT];
 115         uint8_t                 priv[];
 116 };
 117
 118 struct nvme_fc_lport {
 119         struct nvme_fc_local_port       localport;
 120
 121         struct ida                      endp_cnt;
 122         struct list_head                port_list;      /* nvme_fc_port_list */
 123         struct list_head                endp_list;
 124         struct device                   *dev;   /* physical device for dma */
 125         struct nvme_fc_port_template    *ops;
 126         struct kref                     ref;
 127         atomic_t                        act_rport_cnt;
 128 } __aligned(sizeof(u64));       /* alignment for other things alloc'd with */
 129
 130 struct nvme_fc_rport {
 131         struct nvme_fc_remote_port      remoteport;
 132
 133         struct list_head                endp_list; /* for lport->endp_list */
 134         struct list_head                ctrl_list;
 135         struct list_head                ls_req_list;
 136         struct list_head                ls_rcv_list;
 137         struct list_head                disc_list;
 138         struct device                   *dev;   /* physical device for dma */
 139         struct nvme_fc_lport            *lport;
 140         spinlock_t                      lock;
 141         struct kref                     ref;
 142         atomic_t                        act_ctrl_cnt;
 143         unsigned long                   dev_loss_end;
 144         struct work_struct              lsrcv_work;
 145 } __aligned(sizeof(u64));       /* alignment for other things alloc'd with */
 146
 147 /* fc_ctrl flags values - specified as bit positions */
 148 #define ASSOC_ACTIVE            0
 149 #define ASSOC_FAILED            1
 150 #define FCCTRL_TERMIO           2
 151
 152 struct nvme_fc_ctrl {
 153         spinlock_t              lock;
 154         struct nvme_fc_queue    *queues;
 155         struct device           *dev;
 156         struct nvme_fc_lport    *lport;
 157         struct nvme_fc_rport    *rport;
 158         u32                     cnum;
 159
 160         bool                    ioq_live;
 161         u64                     association_id;
 162         struct nvmefc_ls_rcv_op *rcv_disconn;
 163
 164         struct list_head        ctrl_list;      /* rport->ctrl_list */
 165
 166         struct blk_mq_tag_set   admin_tag_set;
 167         struct blk_mq_tag_set   tag_set;
 168
 169         struct delayed_work     connect_work;
 170
 171         struct kref             ref;
 172         unsigned long           flags;
 173         u32                     iocnt;
 174         wait_queue_head_t       ioabort_wait;
 175
 176         struct nvme_fc_fcp_op   aen_ops[NVME_NR_AEN_COMMANDS];
 177
 178         struct nvme_ctrl        ctrl;
 179 };
 180
 181 static inline struct nvme_fc_ctrl *
 182 to_fc_ctrl(struct nvme_ctrl *ctrl)
 183 {
 184         return container_of(ctrl, struct nvme_fc_ctrl, ctrl);
 185 }
 186
 187 static inline struct nvme_fc_lport *
 188 localport_to_lport(struct nvme_fc_local_port *portptr)
 189 {
 190         return container_of(portptr, struct nvme_fc_lport, localport);
 191 }
 192
 193 static inline struct nvme_fc_rport *
 194 remoteport_to_rport(struct nvme_fc_remote_port *portptr)
 195 {
 196         return container_of(portptr, struct nvme_fc_rport, remoteport);
 197 }
 198
 199 static inline struct nvmefc_ls_req_op *
 200 ls_req_to_lsop(struct nvmefc_ls_req *lsreq)
 201 {
 202         return container_of(lsreq, struct nvmefc_ls_req_op, ls_req);
 203 }
 204
 205 static inline struct nvme_fc_fcp_op *
 206 fcp_req_to_fcp_op(struct nvmefc_fcp_req *fcpreq)
 207 {
 208         return container_of(fcpreq, struct nvme_fc_fcp_op, fcp_req);
 209 }
 210
 211
 212
 213 /* *************************** Globals **************************** */
 214
 215
 216 static DEFINE_SPINLOCK(nvme_fc_lock);
 217
 218 static LIST_HEAD(nvme_fc_lport_list);
 219 static DEFINE_IDA(nvme_fc_local_port_cnt);
 220 static DEFINE_IDA(nvme_fc_ctrl_cnt);
 221
 222 static struct workqueue_struct *nvme_fc_wq;
 223
 224 static bool nvme_fc_waiting_to_unload;
 225 static DECLARE_COMPLETION(nvme_fc_unload_proceed);
 226
 227 /*
 228  * These items are short-term. They will eventually be moved into
 229  * a generic FC class. See comments in module init.
 230  */
 231 static struct device *fc_udev_device;
 232
 233 static void nvme_fc_complete_rq(struct request *rq);
 234
 235 /* *********************** FC-NVME Port Management ************************ */
 236
 237 static void __nvme_fc_delete_hw_queue(struct nvme_fc_ctrl *,
 238                         struct nvme_fc_queue *, unsigned int);
 239
 240 static void nvme_fc_handle_ls_rqst_work(struct work_struct *work);
 241
 242
 243 static void
 244 nvme_fc_free_lport(struct kref *ref)
 245 {
 246         struct nvme_fc_lport *lport =
 247                 container_of(ref, struct nvme_fc_lport, ref);
 248         unsigned long flags;
 249
 250         WARN_ON(lport->localport.port_state != FC_OBJSTATE_DELETED);
 251         WARN_ON(!list_empty(&lport->endp_list));
 252
 253         /* remove from transport list */
 254         spin_lock_irqsave(&nvme_fc_lock, flags);
 255         list_del(&lport->port_list);
 256         if (nvme_fc_waiting_to_unload && list_empty(&nvme_fc_lport_list))
 257                 complete(&nvme_fc_unload_proceed);
 258         spin_unlock_irqrestore(&nvme_fc_lock, flags);
 259
 260         ida_simple_remove(&nvme_fc_local_port_cnt, lport->localport.port_num);
 261         ida_destroy(&lport->endp_cnt);
 262
 263         put_device(lport->dev);
 264
 265         kfree(lport);
 266 }
 267
 268 static void
 269 nvme_fc_lport_put(struct nvme_fc_lport *lport)
 270 {
 271         kref_put(&lport->ref, nvme_fc_free_lport);
 272 }
 273
 274 static int
 275 nvme_fc_lport_get(struct nvme_fc_lport *lport)
 276 {
 277         return kref_get_unless_zero(&lport->ref);
 278 }
 279
 280
 281 static struct nvme_fc_lport *
 282 nvme_fc_attach_to_unreg_lport(struct nvme_fc_port_info *pinfo,
 283                         struct nvme_fc_port_template *ops,
 284                         struct device *dev)
 285 {
 286         struct nvme_fc_lport *lport;
 287         unsigned long flags;
 288
 289         spin_lock_irqsave(&nvme_fc_lock, flags);
 290
 291         list_for_each_entry(lport, &nvme_fc_lport_list, port_list) {
 292                 if (lport->localport.node_name != pinfo->node_name ||
 293                     lport->localport.port_name != pinfo->port_name)
 294                         continue;
 295
 296                 if (lport->dev != dev) {
 297                         lport = ERR_PTR(-EXDEV);
 298                         goto out_done;
 299                 }
 300
 301                 if (lport->localport.port_state != FC_OBJSTATE_DELETED) {
 302                         lport = ERR_PTR(-EEXIST);
 303                         goto out_done;
 304                 }
 305
 306                 if (!nvme_fc_lport_get(lport)) {
 307                         /*
 308                          * fails if ref cnt already 0. If so,
 309                          * act as if lport already deleted
 310                          */
 311                         lport = NULL;
 312                         goto out_done;
 313                 }
 314
 315                 /* resume the lport */
 316
 317                 lport->ops = ops;
 318                 lport->localport.port_role = pinfo->port_role;
 319                 lport->localport.port_id = pinfo->port_id;
 320                 lport->localport.port_state = FC_OBJSTATE_ONLINE;
 321
 322                 spin_unlock_irqrestore(&nvme_fc_lock, flags);
 323
 324                 return lport;
 325         }
 326
 327         lport = NULL;
 328
 329 out_done:
 330         spin_unlock_irqrestore(&nvme_fc_lock, flags);
 331
 332         return lport;
 333 }
 334
 335 /**
 336  * nvme_fc_register_localport - transport entry point called by an
 337  *                              LLDD to register the existence of a NVME
 338  *                              host FC port.
 339  * @pinfo:     pointer to information about the port to be registered
 340  * @template:  LLDD entrypoints and operational parameters for the port
 341  * @dev:       physical hardware device node port corresponds to. Will be
 342  *             used for DMA mappings
 343  * @portptr:   pointer to a local port pointer. Upon success, the routine
 344  *             will allocate a nvme_fc_local_port structure and place its
 345  *             address in the local port pointer. Upon failure, local port
 346  *             pointer will be set to 0.
 347  *
 348  * Returns:
 349  * a completion status. Must be 0 upon success; a negative errno
 350  * (ex: -ENXIO) upon failure.
 351  */
 352 int
 353 nvme_fc_register_localport(struct nvme_fc_port_info *pinfo,
 354                         struct nvme_fc_port_template *template,
 355                         struct device *dev,
 356                         struct nvme_fc_local_port **portptr)
 357 {
 358         struct nvme_fc_lport *newrec;
 359         unsigned long flags;
 360         int ret, idx;
 361
 362         if (!template->localport_delete || !template->remoteport_delete ||
 363             !template->ls_req || !template->fcp_io ||
 364             !template->ls_abort || !template->fcp_abort ||
 365             !template->max_hw_queues || !template->max_sgl_segments ||
 366             !template->max_dif_sgl_segments || !template->dma_boundary) {
 367                 ret = -EINVAL;
 368                 goto out_reghost_failed;
 369         }
 370
 371         /*
 372          * look to see if there is already a localport that had been
 373          * deregistered and in the process of waiting for all the
 374          * references to fully be removed.  If the references haven't
 375          * expired, we can simply re-enable the localport. Remoteports
 376          * and controller reconnections should resume naturally.
 377          */
 378         newrec = nvme_fc_attach_to_unreg_lport(pinfo, template, dev);
 379
 380         /* found an lport, but something about its state is bad */
 381         if (IS_ERR(newrec)) {
 382                 ret = PTR_ERR(newrec);
 383                 goto out_reghost_failed;
 384
 385         /* found existing lport, which was resumed */
 386         } else if (newrec) {
 387                 *portptr = &newrec->localport;
 388                 return 0;
 389         }
 390
 391         /* nothing found - allocate a new localport struct */
 392
 393         newrec = kmalloc((sizeof(*newrec) + template->local_priv_sz),
 394                          GFP_KERNEL);
 395         if (!newrec) {
 396                 ret = -ENOMEM;
 397                 goto out_reghost_failed;
 398         }
 399
 400         idx = ida_simple_get(&nvme_fc_local_port_cnt, 0, 0, GFP_KERNEL);
 401         if (idx < 0) {
 402                 ret = -ENOSPC;
 403                 goto out_fail_kfree;
 404         }
 405
 406         if (!get_device(dev) && dev) {
 407                 ret = -ENODEV;
 408                 goto out_ida_put;
 409         }
 410
 411         INIT_LIST_HEAD(&newrec->port_list);
 412         INIT_LIST_HEAD(&newrec->endp_list);
 413         kref_init(&newrec->ref);
 414         atomic_set(&newrec->act_rport_cnt, 0);
 415         newrec->ops = template;
 416         newrec->dev = dev;
 417         ida_init(&newrec->endp_cnt);
 418         if (template->local_priv_sz)
 419                 newrec->localport.private = &newrec[1];
 420         else
 421                 newrec->localport.private = NULL;
 422         newrec->localport.node_name = pinfo->node_name;
 423         newrec->localport.port_name = pinfo->port_name;
 424         newrec->localport.port_role = pinfo->port_role;
 425         newrec->localport.port_id = pinfo->port_id;
 426         newrec->localport.port_state = FC_OBJSTATE_ONLINE;
 427         newrec->localport.port_num = idx;
 428
 429         spin_lock_irqsave(&nvme_fc_lock, flags);
 430         list_add_tail(&newrec->port_list, &nvme_fc_lport_list);
 431         spin_unlock_irqrestore(&nvme_fc_lock, flags);
 432
 433         if (dev)
 434                 dma_set_seg_boundary(dev, template->dma_boundary);
 435
 436         *portptr = &newrec->localport;
 437         return 0;
 438
 439 out_ida_put:
 440         ida_simple_remove(&nvme_fc_local_port_cnt, idx);
 441 out_fail_kfree:
 442         kfree(newrec);
 443 out_reghost_failed:
 444         *portptr = NULL;
 445
 446         return ret;
 447 }
 448 EXPORT_SYMBOL_GPL(nvme_fc_register_localport);
 449
 450 /**
 451  * nvme_fc_unregister_localport - transport entry point called by an
 452  *                              LLDD to deregister/remove a previously
 453  *                              registered a NVME host FC port.
 454  * @portptr: pointer to the (registered) local port that is to be deregistered.
 455  *
 456  * Returns:
 457  * a completion status. Must be 0 upon success; a negative errno
 458  * (ex: -ENXIO) upon failure.
 459  */
 460 int
 461 nvme_fc_unregister_localport(struct nvme_fc_local_port *portptr)
 462 {
 463         struct nvme_fc_lport *lport = localport_to_lport(portptr);
 464         unsigned long flags;
 465
 466         if (!portptr)
 467                 return -EINVAL;
 468
 469         spin_lock_irqsave(&nvme_fc_lock, flags);
 470
 471         if (portptr->port_state != FC_OBJSTATE_ONLINE) {
 472                 spin_unlock_irqrestore(&nvme_fc_lock, flags);
 473                 return -EINVAL;
 474         }
 475         portptr->port_state = FC_OBJSTATE_DELETED;
 476
 477         spin_unlock_irqrestore(&nvme_fc_lock, flags);
 478
 479         if (atomic_read(&lport->act_rport_cnt) == 0)
 480                 lport->ops->localport_delete(&lport->localport);
 481
 482         nvme_fc_lport_put(lport);
 483
 484         return 0;
 485 }
 486 EXPORT_SYMBOL_GPL(nvme_fc_unregister_localport);
 487
 488 /*
 489  * TRADDR strings, per FC-NVME are fixed format:
 490  *   "nn-0x<16hexdigits>:pn-0x<16hexdigits>" - 43 characters
 491  * udev event will only differ by prefix of what field is
 492  * being specified:
 493  *    "NVMEFC_HOST_TRADDR=" or "NVMEFC_TRADDR=" - 19 max characters
 494  *  19 + 43 + null_fudge = 64 characters
 495  */
 496 #define FCNVME_TRADDR_LENGTH            64
 497
 498 static void
 499 nvme_fc_signal_discovery_scan(struct nvme_fc_lport *lport,
 500                 struct nvme_fc_rport *rport)
 501 {
 502         char hostaddr[FCNVME_TRADDR_LENGTH];    /* NVMEFC_HOST_TRADDR=...*/
 503         char tgtaddr[FCNVME_TRADDR_LENGTH];     /* NVMEFC_TRADDR=...*/
 504         char *envp[4] = { "FC_EVENT=nvmediscovery", hostaddr, tgtaddr, NULL };
 505
 506         if (!(rport->remoteport.port_role & FC_PORT_ROLE_NVME_DISCOVERY))
 507                 return;
 508
 509         snprintf(hostaddr, sizeof(hostaddr),
 510                 "NVMEFC_HOST_TRADDR=nn-0x%016llx:pn-0x%016llx",
 511                 lport->localport.node_name, lport->localport.port_name);
 512         snprintf(tgtaddr, sizeof(tgtaddr),
 513                 "NVMEFC_TRADDR=nn-0x%016llx:pn-0x%016llx",
 514                 rport->remoteport.node_name, rport->remoteport.port_name);
 515         kobject_uevent_env(&fc_udev_device->kobj, KOBJ_CHANGE, envp);
 516 }
 517
 518 static void
 519 nvme_fc_free_rport(struct kref *ref)
 520 {
 521         struct nvme_fc_rport *rport =
 522                 container_of(ref, struct nvme_fc_rport, ref);
 523         struct nvme_fc_lport *lport =
 524                         localport_to_lport(rport->remoteport.localport);
 525         unsigned long flags;
 526
 527         WARN_ON(rport->remoteport.port_state != FC_OBJSTATE_DELETED);
 528         WARN_ON(!list_empty(&rport->ctrl_list));
 529
 530         /* remove from lport list */
 531         spin_lock_irqsave(&nvme_fc_lock, flags);
 532         list_del(&rport->endp_list);
 533         spin_unlock_irqrestore(&nvme_fc_lock, flags);
 534
 535         WARN_ON(!list_empty(&rport->disc_list));
 536         ida_simple_remove(&lport->endp_cnt, rport->remoteport.port_num);
 537
 538         kfree(rport);
 539
 540         nvme_fc_lport_put(lport);
 541 }
 542
 543 static void
 544 nvme_fc_rport_put(struct nvme_fc_rport *rport)
 545 {
 546         kref_put(&rport->ref, nvme_fc_free_rport);
 547 }
 548
 549 static int
 550 nvme_fc_rport_get(struct nvme_fc_rport *rport)
 551 {
 552         return kref_get_unless_zero(&rport->ref);
 553 }
 554
 555 static void
 556 nvme_fc_resume_controller(struct nvme_fc_ctrl *ctrl)
 557 {
 558         switch (ctrl->ctrl.state) {
 559         case NVME_CTRL_NEW:
 560         case NVME_CTRL_CONNECTING:
 561                 /*
 562                  * As all reconnects were suppressed, schedule a
 563                  * connect.
 564                  */
 565                 dev_info(ctrl->ctrl.device,
 566                         "NVME-FC{%d}: connectivity re-established. "
 567                         "Attempting reconnect\n", ctrl->cnum);
 568
 569                 queue_delayed_work(nvme_wq, &ctrl->connect_work, 0);
 570                 break;
 571
 572         case NVME_CTRL_RESETTING:
 573                 /*
 574                  * Controller is already in the process of terminating the
 575                  * association. No need to do anything further. The reconnect
 576                  * step will naturally occur after the reset completes.
 577                  */
 578                 break;
 579
 580         default:
 581                 /* no action to take - let it delete */
 582                 break;
 583         }
 584 }
 585
 586 static struct nvme_fc_rport *
 587 nvme_fc_attach_to_suspended_rport(struct nvme_fc_lport *lport,
 588                                 struct nvme_fc_port_info *pinfo)
 589 {
 590         struct nvme_fc_rport *rport;
 591         struct nvme_fc_ctrl *ctrl;
 592         unsigned long flags;
 593
 594         spin_lock_irqsave(&nvme_fc_lock, flags);
 595
 596         list_for_each_entry(rport, &lport->endp_list, endp_list) {
 597                 if (rport->remoteport.node_name != pinfo->node_name ||
 598                     rport->remoteport.port_name != pinfo->port_name)
 599                         continue;
 600
 601                 if (!nvme_fc_rport_get(rport)) {
 602                         rport = ERR_PTR(-ENOLCK);
 603                         goto out_done;
 604                 }
 605
 606                 spin_unlock_irqrestore(&nvme_fc_lock, flags);
 607
 608                 spin_lock_irqsave(&rport->lock, flags);
 609
 610                 /* has it been unregistered */
 611                 if (rport->remoteport.port_state != FC_OBJSTATE_DELETED) {
 612                         /* means lldd called us twice */
 613                         spin_unlock_irqrestore(&rport->lock, flags);
 614                         nvme_fc_rport_put(rport);
 615                         return ERR_PTR(-ESTALE);
 616                 }
 617
 618                 rport->remoteport.port_role = pinfo->port_role;
 619                 rport->remoteport.port_id = pinfo->port_id;
 620                 rport->remoteport.port_state = FC_OBJSTATE_ONLINE;
 621                 rport->dev_loss_end = 0;
 622
 623                 /*
 624                  * kick off a reconnect attempt on all associations to the
 625                  * remote port. A successful reconnects will resume i/o.
 626                  */
 627                 list_for_each_entry(ctrl, &rport->ctrl_list, ctrl_list)
 628                         nvme_fc_resume_controller(ctrl);
 629
 630                 spin_unlock_irqrestore(&rport->lock, flags);
 631
 632                 return rport;
 633         }
 634
 635         rport = NULL;
 636
 637 out_done:
 638         spin_unlock_irqrestore(&nvme_fc_lock, flags);
 639
 640         return rport;
 641 }
 642
 643 static inline void
 644 __nvme_fc_set_dev_loss_tmo(struct nvme_fc_rport *rport,
 645                         struct nvme_fc_port_info *pinfo)
 646 {
 647         if (pinfo->dev_loss_tmo)
 648                 rport->remoteport.dev_loss_tmo = pinfo->dev_loss_tmo;
 649         else
 650                 rport->remoteport.dev_loss_tmo = NVME_FC_DEFAULT_DEV_LOSS_TMO;
 651 }
 652
 653 /**
 654  * nvme_fc_register_remoteport - transport entry point called by an
 655  *                              LLDD to register the existence of a NVME
 656  *                              subsystem FC port on its fabric.
 657  * @localport: pointer to the (registered) local port that the remote
 658  *             subsystem port is connected to.
 659  * @pinfo:     pointer to information about the port to be registered
 660  * @portptr:   pointer to a remote port pointer. Upon success, the routine
 661  *             will allocate a nvme_fc_remote_port structure and place its
 662  *             address in the remote port pointer. Upon failure, remote port
 663  *             pointer will be set to 0.
 664  *
 665  * Returns:
 666  * a completion status. Must be 0 upon success; a negative errno
 667  * (ex: -ENXIO) upon failure.
 668  */
 669 int
 670 nvme_fc_register_remoteport(struct nvme_fc_local_port *localport,
 671                                 struct nvme_fc_port_info *pinfo,
 672                                 struct nvme_fc_remote_port **portptr)
 673 {
 674         struct nvme_fc_lport *lport = localport_to_lport(localport);
 675         struct nvme_fc_rport *newrec;
 676         unsigned long flags;
 677         int ret, idx;
 678
 679         if (!nvme_fc_lport_get(lport)) {
 680                 ret = -ESHUTDOWN;
 681                 goto out_reghost_failed;
 682         }
 683
 684         /*
 685          * look to see if there is already a remoteport that is waiting
 686          * for a reconnect (within dev_loss_tmo) with the same WWN's.
 687          * If so, transition to it and reconnect.
 688          */
 689         newrec = nvme_fc_attach_to_suspended_rport(lport, pinfo);
 690
 691         /* found an rport, but something about its state is bad */
 692         if (IS_ERR(newrec)) {
 693                 ret = PTR_ERR(newrec);
 694                 goto out_lport_put;
 695
 696         /* found existing rport, which was resumed */
 697         } else if (newrec) {
 698                 nvme_fc_lport_put(lport);
 699                 __nvme_fc_set_dev_loss_tmo(newrec, pinfo);
 700                 nvme_fc_signal_discovery_scan(lport, newrec);
 701                 *portptr = &newrec->remoteport;
 702                 return 0;
 703         }
 704
 705         /* nothing found - allocate a new remoteport struct */
 706
 707         newrec = kmalloc((sizeof(*newrec) + lport->ops->remote_priv_sz),
 708                          GFP_KERNEL);
 709         if (!newrec) {
 710                 ret = -ENOMEM;
 711                 goto out_lport_put;
 712         }
 713
 714         idx = ida_simple_get(&lport->endp_cnt, 0, 0, GFP_KERNEL);
 715         if (idx < 0) {
 716                 ret = -ENOSPC;
 717                 goto out_kfree_rport;
 718         }
 719
 720         INIT_LIST_HEAD(&newrec->endp_list);
 721         INIT_LIST_HEAD(&newrec->ctrl_list);
 722         INIT_LIST_HEAD(&newrec->ls_req_list);
 723         INIT_LIST_HEAD(&newrec->disc_list);
 724         kref_init(&newrec->ref);
 725         atomic_set(&newrec->act_ctrl_cnt, 0);
 726         spin_lock_init(&newrec->lock);
 727         newrec->remoteport.localport = &lport->localport;
 728         INIT_LIST_HEAD(&newrec->ls_rcv_list);
 729         newrec->dev = lport->dev;
 730         newrec->lport = lport;
 731         if (lport->ops->remote_priv_sz)
 732                 newrec->remoteport.private = &newrec[1];
 733         else
 734                 newrec->remoteport.private = NULL;
 735         newrec->remoteport.port_role = pinfo->port_role;
 736         newrec->remoteport.node_name = pinfo->node_name;
 737         newrec->remoteport.port_name = pinfo->port_name;
 738         newrec->remoteport.port_id = pinfo->port_id;
 739         newrec->remoteport.port_state = FC_OBJSTATE_ONLINE;
 740         newrec->remoteport.port_num = idx;
 741         __nvme_fc_set_dev_loss_tmo(newrec, pinfo);
 742         INIT_WORK(&newrec->lsrcv_work, nvme_fc_handle_ls_rqst_work);
 743
 744         spin_lock_irqsave(&nvme_fc_lock, flags);
 745         list_add_tail(&newrec->endp_list, &lport->endp_list);
 746         spin_unlock_irqrestore(&nvme_fc_lock, flags);
 747
 748         nvme_fc_signal_discovery_scan(lport, newrec);
 749
 750         *portptr = &newrec->remoteport;
 751         return 0;
 752
 753 out_kfree_rport:
 754         kfree(newrec);
 755 out_lport_put:
 756         nvme_fc_lport_put(lport);
 757 out_reghost_failed:
 758         *portptr = NULL;
 759         return ret;
 760 }
 761 EXPORT_SYMBOL_GPL(nvme_fc_register_remoteport);
 762
 763 static int
 764 nvme_fc_abort_lsops(struct nvme_fc_rport *rport)
 765 {
 766         struct nvmefc_ls_req_op *lsop;
 767         unsigned long flags;
 768
 769 restart:
 770         spin_lock_irqsave(&rport->lock, flags);
 771
 772         list_for_each_entry(lsop, &rport->ls_req_list, lsreq_list) {
 773                 if (!(lsop->flags & FCOP_FLAGS_TERMIO)) {
 774                         lsop->flags |= FCOP_FLAGS_TERMIO;
 775                         spin_unlock_irqrestore(&rport->lock, flags);
 776                         rport->lport->ops->ls_abort(&rport->lport->localport,
 777                                                 &rport->remoteport,
 778                                                 &lsop->ls_req);
 779                         goto restart;
 780                 }
 781         }
 782         spin_unlock_irqrestore(&rport->lock, flags);
 783
 784         return 0;
 785 }
 786
 787 static void
 788 nvme_fc_ctrl_connectivity_loss(struct nvme_fc_ctrl *ctrl)
 789 {
 790         dev_info(ctrl->ctrl.device,
 791                 "NVME-FC{%d}: controller connectivity lost. Awaiting "
 792                 "Reconnect", ctrl->cnum);
 793
 794         switch (ctrl->ctrl.state) {
 795         case NVME_CTRL_NEW:
 796         case NVME_CTRL_LIVE:
 797                 /*
 798                  * Schedule a controller reset. The reset will terminate the
 799                  * association and schedule the reconnect timer.  Reconnects
 800                  * will be attempted until either the ctlr_loss_tmo
 801                  * (max_retries * connect_delay) expires or the remoteport's
 802                  * dev_loss_tmo expires.
 803                  */
 804                 if (nvme_reset_ctrl(&ctrl->ctrl)) {
 805                         dev_warn(ctrl->ctrl.device,
 806                                 "NVME-FC{%d}: Couldn't schedule reset.\n",
 807                                 ctrl->cnum);
 808                         nvme_delete_ctrl(&ctrl->ctrl);
 809                 }
 810                 break;
 811
 812         case NVME_CTRL_CONNECTING:
 813                 /*
 814                  * The association has already been terminated and the
 815                  * controller is attempting reconnects.  No need to do anything
 816                  * futher.  Reconnects will be attempted until either the
 817                  * ctlr_loss_tmo (max_retries * connect_delay) expires or the
 818                  * remoteport's dev_loss_tmo expires.
 819                  */
 820                 break;
 821
 822         case NVME_CTRL_RESETTING:
 823                 /*
 824                  * Controller is already in the process of terminating the
 825                  * association.  No need to do anything further. The reconnect
 826                  * step will kick in naturally after the association is
 827                  * terminated.
 828                  */
 829                 break;
 830
 831         case NVME_CTRL_DELETING:
 832         case NVME_CTRL_DELETING_NOIO:
 833         default:
 834                 /* no action to take - let it delete */
 835                 break;
 836         }
 837 }
 838
 839 /**
 840  * nvme_fc_unregister_remoteport - transport entry point called by an
 841  *                              LLDD to deregister/remove a previously
 842  *                              registered a NVME subsystem FC port.
 843  * @portptr: pointer to the (registered) remote port that is to be
 844  *           deregistered.
 845  *
 846  * Returns:
 847  * a completion status. Must be 0 upon success; a negative errno
 848  * (ex: -ENXIO) upon failure.
 849  */
 850 int
 851 nvme_fc_unregister_remoteport(struct nvme_fc_remote_port *portptr)
 852 {
 853         struct nvme_fc_rport *rport = remoteport_to_rport(portptr);
 854         struct nvme_fc_ctrl *ctrl;
 855         unsigned long flags;
 856
 857         if (!portptr)
 858                 return -EINVAL;
 859
 860         spin_lock_irqsave(&rport->lock, flags);
 861
 862         if (portptr->port_state != FC_OBJSTATE_ONLINE) {
 863                 spin_unlock_irqrestore(&rport->lock, flags);
 864                 return -EINVAL;
 865         }
 866         portptr->port_state = FC_OBJSTATE_DELETED;
 867
 868         rport->dev_loss_end = jiffies + (portptr->dev_loss_tmo * HZ);
 869
 870         list_for_each_entry(ctrl, &rport->ctrl_list, ctrl_list) {
 871                 /* if dev_loss_tmo==0, dev loss is immediate */
 872                 if (!portptr->dev_loss_tmo) {
 873                         dev_warn(ctrl->ctrl.device,
 874                                 "NVME-FC{%d}: controller connectivity lost.\n",
 875                                 ctrl->cnum);
 876                         nvme_delete_ctrl(&ctrl->ctrl);
 877                 } else
 878                         nvme_fc_ctrl_connectivity_loss(ctrl);
 879         }
 880
 881         spin_unlock_irqrestore(&rport->lock, flags);
 882
 883         nvme_fc_abort_lsops(rport);
 884
 885         if (atomic_read(&rport->act_ctrl_cnt) == 0)
 886                 rport->lport->ops->remoteport_delete(portptr);
 887
 888         /*
 889          * release the reference, which will allow, if all controllers
 890          * go away, which should only occur after dev_loss_tmo occurs,
 891          * for the rport to be torn down.
 892          */
 893         nvme_fc_rport_put(rport);
 894
 895         return 0;
 896 }
 897 EXPORT_SYMBOL_GPL(nvme_fc_unregister_remoteport);
 898
 899 /**
 900  * nvme_fc_rescan_remoteport - transport entry point called by an
 901  *                              LLDD to request a nvme device rescan.
 902  * @remoteport: pointer to the (registered) remote port that is to be
 903  *              rescanned.
 904  *
 905  * Returns: N/A
 906  */
 907 void
 908 nvme_fc_rescan_remoteport(struct nvme_fc_remote_port *remoteport)
 909 {
 910         struct nvme_fc_rport *rport = remoteport_to_rport(remoteport);
 911
 912         nvme_fc_signal_discovery_scan(rport->lport, rport);
 913 }
 914 EXPORT_SYMBOL_GPL(nvme_fc_rescan_remoteport);
 915
 916 int
 917 nvme_fc_set_remoteport_devloss(struct nvme_fc_remote_port *portptr,
 918                         u32 dev_loss_tmo)
 919 {
 920         struct nvme_fc_rport *rport = remoteport_to_rport(portptr);
 921         unsigned long flags;
 922
 923         spin_lock_irqsave(&rport->lock, flags);
 924
 925         if (portptr->port_state != FC_OBJSTATE_ONLINE) {
 926                 spin_unlock_irqrestore(&rport->lock, flags);
 927                 return -EINVAL;
 928         }
 929
 930         /* a dev_loss_tmo of 0 (immediate) is allowed to be set */
 931         rport->remoteport.dev_loss_tmo = dev_loss_tmo;
 932
 933         spin_unlock_irqrestore(&rport->lock, flags);
 934
 935         return 0;
 936 }
 937 EXPORT_SYMBOL_GPL(nvme_fc_set_remoteport_devloss);
 938
 939
 940 /* *********************** FC-NVME DMA Handling **************************** */
 941
 942 /*
 943  * The fcloop device passes in a NULL device pointer. Real LLD's will
 944  * pass in a valid device pointer. If NULL is passed to the dma mapping
 945  * routines, depending on the platform, it may or may not succeed, and
 946  * may crash.
 947  *
 948  * As such:
 949  * Wrapper all the dma routines and check the dev pointer.
 950  *
 951  * If simple mappings (return just a dma address, we'll noop them,
 952  * returning a dma address of 0.
 953  *
 954  * On more complex mappings (dma_map_sg), a pseudo routine fills
 955  * in the scatter list, setting all dma addresses to 0.
 956  */
 957
 958 static inline dma_addr_t
 959 fc_dma_map_single(struct device *dev, void *ptr, size_t size,
 960                 enum dma_data_direction dir)
 961 {
 962         return dev ? dma_map_single(dev, ptr, size, dir) : (dma_addr_t)0L;
 963 }
 964
 965 static inline int
 966 fc_dma_mapping_error(struct device *dev, dma_addr_t dma_addr)
 967 {
 968         return dev ? dma_mapping_error(dev, dma_addr) : 0;
 969 }
 970
 971 static inline void
 972 fc_dma_unmap_single(struct device *dev, dma_addr_t addr, size_t size,
 973         enum dma_data_direction dir)
 974 {
 975         if (dev)
 976                 dma_unmap_single(dev, addr, size, dir);
 977 }
 978
 979 static inline void
 980 fc_dma_sync_single_for_cpu(struct device *dev, dma_addr_t addr, size_t size,
 981                 enum dma_data_direction dir)
 982 {
 983         if (dev)
 984                 dma_sync_single_for_cpu(dev, addr, size, dir);
 985 }
 986
 987 static inline void
 988 fc_dma_sync_single_for_device(struct device *dev, dma_addr_t addr, size_t size,
 989                 enum dma_data_direction dir)
 990 {
 991         if (dev)
 992                 dma_sync_single_for_device(dev, addr, size, dir);
 993 }
 994
 995 /* pseudo dma_map_sg call */
 996 static int
 997 fc_map_sg(struct scatterlist *sg, int nents)
 998 {
 999         struct scatterlist *s;
1000         int i;
1001
1002         WARN_ON(nents == 0 || sg[0].length == 0);
1003
1004         for_each_sg(sg, s, nents, i) {
1005                 s->dma_address = 0L;
1006 #ifdef CONFIG_NEED_SG_DMA_LENGTH
1007                 s->dma_length = s->length;
1008 #endif
1009         }
1010         return nents;
1011 }
1012
1013 static inline int
1014 fc_dma_map_sg(struct device *dev, struct scatterlist *sg, int nents,
1015                 enum dma_data_direction dir)
1016 {
1017         return dev ? dma_map_sg(dev, sg, nents, dir) : fc_map_sg(sg, nents);
1018 }
1019
1020 static inline void
1021 fc_dma_unmap_sg(struct device *dev, struct scatterlist *sg, int nents,
1022                 enum dma_data_direction dir)
1023 {
1024         if (dev)
1025                 dma_unmap_sg(dev, sg, nents, dir);
1026 }
1027
1028 /* *********************** FC-NVME LS Handling **************************** */
1029
1030 static void nvme_fc_ctrl_put(struct nvme_fc_ctrl *);
1031 static int nvme_fc_ctrl_get(struct nvme_fc_ctrl *);
1032
1033 static void nvme_fc_error_recovery(struct nvme_fc_ctrl *ctrl, char *errmsg);
1034
1035 static void
1036 __nvme_fc_finish_ls_req(struct nvmefc_ls_req_op *lsop)
1037 {
1038         struct nvme_fc_rport *rport = lsop->rport;
1039         struct nvmefc_ls_req *lsreq = &lsop->ls_req;
1040         unsigned long flags;
1041
1042         spin_lock_irqsave(&rport->lock, flags);
1043
1044         if (!lsop->req_queued) {
1045                 spin_unlock_irqrestore(&rport->lock, flags);
1046                 return;
1047         }
1048
1049         list_del(&lsop->lsreq_list);
1050
1051         lsop->req_queued = false;
1052
1053         spin_unlock_irqrestore(&rport->lock, flags);
1054
1055         fc_dma_unmap_single(rport->dev, lsreq->rqstdma,
1056                                   (lsreq->rqstlen + lsreq->rsplen),
1057                                   DMA_BIDIRECTIONAL);
1058
1059         nvme_fc_rport_put(rport);
1060 }
1061
1062 static int
1063 __nvme_fc_send_ls_req(struct nvme_fc_rport *rport,
1064                 struct nvmefc_ls_req_op *lsop,
1065                 void (*done)(struct nvmefc_ls_req *req, int status))
1066 {
1067         struct nvmefc_ls_req *lsreq = &lsop->ls_req;
1068         unsigned long flags;
1069         int ret = 0;
1070
1071         if (rport->remoteport.port_state != FC_OBJSTATE_ONLINE)
1072                 return -ECONNREFUSED;
1073
1074         if (!nvme_fc_rport_get(rport))
1075                 return -ESHUTDOWN;
1076
1077         lsreq->done = done;
1078         lsop->rport = rport;
1079         lsop->req_queued = false;
1080         INIT_LIST_HEAD(&lsop->lsreq_list);
1081         init_completion(&lsop->ls_done);
1082
1083         lsreq->rqstdma = fc_dma_map_single(rport->dev, lsreq->rqstaddr,
1084                                   lsreq->rqstlen + lsreq->rsplen,
1085                                   DMA_BIDIRECTIONAL);
1086         if (fc_dma_mapping_error(rport->dev, lsreq->rqstdma)) {
1087                 ret = -EFAULT;
1088                 goto out_putrport;
1089         }
1090         lsreq->rspdma = lsreq->rqstdma + lsreq->rqstlen;
1091
1092         spin_lock_irqsave(&rport->lock, flags);
1093
1094         list_add_tail(&lsop->lsreq_list, &rport->ls_req_list);
1095
1096         lsop->req_queued = true;
1097
1098         spin_unlock_irqrestore(&rport->lock, flags);
1099
1100         ret = rport->lport->ops->ls_req(&rport->lport->localport,
1101                                         &rport->remoteport, lsreq);
1102         if (ret)
1103                 goto out_unlink;
1104
1105         return 0;
1106
1107 out_unlink:
1108         lsop->ls_error = ret;
1109         spin_lock_irqsave(&rport->lock, flags);
1110         lsop->req_queued = false;
1111         list_del(&lsop->lsreq_list);
1112         spin_unlock_irqrestore(&rport->lock, flags);
1113         fc_dma_unmap_single(rport->dev, lsreq->rqstdma,
1114                                   (lsreq->rqstlen + lsreq->rsplen),
1115                                   DMA_BIDIRECTIONAL);
1116 out_putrport:
1117         nvme_fc_rport_put(rport);
1118
1119         return ret;
1120 }
1121
1122 static void
1123 nvme_fc_send_ls_req_done(struct nvmefc_ls_req *lsreq, int status)
1124 {
1125         struct nvmefc_ls_req_op *lsop = ls_req_to_lsop(lsreq);
1126
1127         lsop->ls_error = status;
1128         complete(&lsop->ls_done);
1129 }
1130
1131 static int
1132 nvme_fc_send_ls_req(struct nvme_fc_rport *rport, struct nvmefc_ls_req_op *lsop)
1133 {
1134         struct nvmefc_ls_req *lsreq = &lsop->ls_req;
1135         struct fcnvme_ls_rjt *rjt = lsreq->rspaddr;
1136         int ret;
1137
1138         ret = __nvme_fc_send_ls_req(rport, lsop, nvme_fc_send_ls_req_done);
1139
1140         if (!ret) {
1141                 /*
1142                  * No timeout/not interruptible as we need the struct
1143                  * to exist until the lldd calls us back. Thus mandate
1144                  * wait until driver calls back. lldd responsible for
1145                  * the timeout action
1146                  */
1147                 wait_for_completion(&lsop->ls_done);
1148
1149                 __nvme_fc_finish_ls_req(lsop);
1150
1151                 ret = lsop->ls_error;
1152         }
1153
1154         if (ret)
1155                 return ret;
1156
1157         /* ACC or RJT payload ? */
1158         if (rjt->w0.ls_cmd == FCNVME_LS_RJT)
1159                 return -ENXIO;
1160
1161         return 0;
1162 }
1163
1164 static int
1165 nvme_fc_send_ls_req_async(struct nvme_fc_rport *rport,
1166                 struct nvmefc_ls_req_op *lsop,
1167                 void (*done)(struct nvmefc_ls_req *req, int status))
1168 {
1169         /* don't wait for completion */
1170
1171         return __nvme_fc_send_ls_req(rport, lsop, done);
1172 }
1173
1174 static int
1175 nvme_fc_connect_admin_queue(struct nvme_fc_ctrl *ctrl,
1176         struct nvme_fc_queue *queue, u16 qsize, u16 ersp_ratio)
1177 {
1178         struct nvmefc_ls_req_op *lsop;
1179         struct nvmefc_ls_req *lsreq;
1180         struct fcnvme_ls_cr_assoc_rqst *assoc_rqst;
1181         struct fcnvme_ls_cr_assoc_acc *assoc_acc;
1182         unsigned long flags;
1183         int ret, fcret = 0;
1184
1185         lsop = kzalloc((sizeof(*lsop) +
1186                          sizeof(*assoc_rqst) + sizeof(*assoc_acc) +
1187                          ctrl->lport->ops->lsrqst_priv_sz), GFP_KERNEL);
1188         if (!lsop) {
1189                 dev_info(ctrl->ctrl.device,
1190                         "NVME-FC{%d}: send Create Association failed: ENOMEM\n",
1191                         ctrl->cnum);
1192                 ret = -ENOMEM;
1193                 goto out_no_memory;
1194         }
1195
1196         assoc_rqst = (struct fcnvme_ls_cr_assoc_rqst *)&lsop[1];
1197         assoc_acc = (struct fcnvme_ls_cr_assoc_acc *)&assoc_rqst[1];
1198         lsreq = &lsop->ls_req;
1199         if (ctrl->lport->ops->lsrqst_priv_sz)
1200                 lsreq->private = &assoc_acc[1];
1201         else
1202                 lsreq->private = NULL;
1203
1204         assoc_rqst->w0.ls_cmd = FCNVME_LS_CREATE_ASSOCIATION;
1205         assoc_rqst->desc_list_len =
1206                         cpu_to_be32(sizeof(struct fcnvme_lsdesc_cr_assoc_cmd));
1207
1208         assoc_rqst->assoc_cmd.desc_tag =
1209                         cpu_to_be32(FCNVME_LSDESC_CREATE_ASSOC_CMD);
1210         assoc_rqst->assoc_cmd.desc_len =
1211                         fcnvme_lsdesc_len(
1212                                 sizeof(struct fcnvme_lsdesc_cr_assoc_cmd));
1213
1214         assoc_rqst->assoc_cmd.ersp_ratio = cpu_to_be16(ersp_ratio);
1215         assoc_rqst->assoc_cmd.sqsize = cpu_to_be16(qsize - 1);
1216         /* Linux supports only Dynamic controllers */
1217         assoc_rqst->assoc_cmd.cntlid = cpu_to_be16(0xffff);
1218         uuid_copy(&assoc_rqst->assoc_cmd.hostid, &ctrl->ctrl.opts->host->id);
1219         strncpy(assoc_rqst->assoc_cmd.hostnqn, ctrl->ctrl.opts->host->nqn,
1220                 min(FCNVME_ASSOC_HOSTNQN_LEN, NVMF_NQN_SIZE));
1221         strncpy(assoc_rqst->assoc_cmd.subnqn, ctrl->ctrl.opts->subsysnqn,
1222                 min(FCNVME_ASSOC_SUBNQN_LEN, NVMF_NQN_SIZE));
1223
1224         lsop->queue = queue;
1225         lsreq->rqstaddr = assoc_rqst;
1226         lsreq->rqstlen = sizeof(*assoc_rqst);
1227         lsreq->rspaddr = assoc_acc;
1228         lsreq->rsplen = sizeof(*assoc_acc);
1229         lsreq->timeout = NVME_FC_LS_TIMEOUT_SEC;
1230
1231         ret = nvme_fc_send_ls_req(ctrl->rport, lsop);
1232         if (ret)
1233                 goto out_free_buffer;
1234
1235         /* process connect LS completion */
1236
1237         /* validate the ACC response */
1238         if (assoc_acc->hdr.w0.ls_cmd != FCNVME_LS_ACC)
1239                 fcret = VERR_LSACC;
1240         else if (assoc_acc->hdr.desc_list_len !=
1241                         fcnvme_lsdesc_len(
1242                                 sizeof(struct fcnvme_ls_cr_assoc_acc)))
1243                 fcret = VERR_CR_ASSOC_ACC_LEN;
1244         else if (assoc_acc->hdr.rqst.desc_tag !=
1245                         cpu_to_be32(FCNVME_LSDESC_RQST))
1246                 fcret = VERR_LSDESC_RQST;
1247         else if (assoc_acc->hdr.rqst.desc_len !=
1248                         fcnvme_lsdesc_len(sizeof(struct fcnvme_lsdesc_rqst)))
1249                 fcret = VERR_LSDESC_RQST_LEN;
1250         else if (assoc_acc->hdr.rqst.w0.ls_cmd != FCNVME_LS_CREATE_ASSOCIATION)
1251                 fcret = VERR_CR_ASSOC;
1252         else if (assoc_acc->associd.desc_tag !=
1253                         cpu_to_be32(FCNVME_LSDESC_ASSOC_ID))
1254                 fcret = VERR_ASSOC_ID;
1255         else if (assoc_acc->associd.desc_len !=
1256                         fcnvme_lsdesc_len(
1257                                 sizeof(struct fcnvme_lsdesc_assoc_id)))
1258                 fcret = VERR_ASSOC_ID_LEN;
1259         else if (assoc_acc->connectid.desc_tag !=
1260                         cpu_to_be32(FCNVME_LSDESC_CONN_ID))
1261                 fcret = VERR_CONN_ID;
1262         else if (assoc_acc->connectid.desc_len !=
1263                         fcnvme_lsdesc_len(sizeof(struct fcnvme_lsdesc_conn_id)))
1264                 fcret = VERR_CONN_ID_LEN;
1265
1266         if (fcret) {
1267                 ret = -EBADF;
1268                 dev_err(ctrl->dev,
1269                         "q %d Create Association LS failed: %s\n",
1270                         queue->qnum, validation_errors[fcret]);
1271         } else {
1272                 spin_lock_irqsave(&ctrl->lock, flags);
1273                 ctrl->association_id =
1274                         be64_to_cpu(assoc_acc->associd.association_id);
1275                 queue->connection_id =
1276                         be64_to_cpu(assoc_acc->connectid.connection_id);
1277                 set_bit(NVME_FC_Q_CONNECTED, &queue->flags);
1278                 spin_unlock_irqrestore(&ctrl->lock, flags);
1279         }
1280
1281 out_free_buffer:
1282         kfree(lsop);
1283 out_no_memory:
1284         if (ret)
1285                 dev_err(ctrl->dev,
1286                         "queue %d connect admin queue failed (%d).\n",
1287                         queue->qnum, ret);
1288         return ret;
1289 }
1290
1291 static int
1292 nvme_fc_connect_queue(struct nvme_fc_ctrl *ctrl, struct nvme_fc_queue *queue,
1293                         u16 qsize, u16 ersp_ratio)
1294 {
1295         struct nvmefc_ls_req_op *lsop;
1296         struct nvmefc_ls_req *lsreq;
1297         struct fcnvme_ls_cr_conn_rqst *conn_rqst;
1298         struct fcnvme_ls_cr_conn_acc *conn_acc;
1299         int ret, fcret = 0;
1300
1301         lsop = kzalloc((sizeof(*lsop) +
1302                          sizeof(*conn_rqst) + sizeof(*conn_acc) +
1303                          ctrl->lport->ops->lsrqst_priv_sz), GFP_KERNEL);
1304         if (!lsop) {
1305                 dev_info(ctrl->ctrl.device,
1306                         "NVME-FC{%d}: send Create Connection failed: ENOMEM\n",
1307                         ctrl->cnum);
1308                 ret = -ENOMEM;
1309                 goto out_no_memory;
1310         }
1311
1312         conn_rqst = (struct fcnvme_ls_cr_conn_rqst *)&lsop[1];
1313         conn_acc = (struct fcnvme_ls_cr_conn_acc *)&conn_rqst[1];
1314         lsreq = &lsop->ls_req;
1315         if (ctrl->lport->ops->lsrqst_priv_sz)
1316                 lsreq->private = (void *)&conn_acc[1];
1317         else
1318                 lsreq->private = NULL;
1319
1320         conn_rqst->w0.ls_cmd = FCNVME_LS_CREATE_CONNECTION;
1321         conn_rqst->desc_list_len = cpu_to_be32(
1322                                 sizeof(struct fcnvme_lsdesc_assoc_id) +
1323                                 sizeof(struct fcnvme_lsdesc_cr_conn_cmd));
1324
1325         conn_rqst->associd.desc_tag = cpu_to_be32(FCNVME_LSDESC_ASSOC_ID);
1326         conn_rqst->associd.desc_len =
1327                         fcnvme_lsdesc_len(
1328                                 sizeof(struct fcnvme_lsdesc_assoc_id));
1329         conn_rqst->associd.association_id = cpu_to_be64(ctrl->association_id);
1330         conn_rqst->connect_cmd.desc_tag =
1331                         cpu_to_be32(FCNVME_LSDESC_CREATE_CONN_CMD);
1332         conn_rqst->connect_cmd.desc_len =
1333                         fcnvme_lsdesc_len(
1334                                 sizeof(struct fcnvme_lsdesc_cr_conn_cmd));
1335         conn_rqst->connect_cmd.ersp_ratio = cpu_to_be16(ersp_ratio);
1336         conn_rqst->connect_cmd.qid  = cpu_to_be16(queue->qnum);
1337         conn_rqst->connect_cmd.sqsize = cpu_to_be16(qsize - 1);
1338
1339         lsop->queue = queue;
1340         lsreq->rqstaddr = conn_rqst;
1341         lsreq->rqstlen = sizeof(*conn_rqst);
1342         lsreq->rspaddr = conn_acc;
1343         lsreq->rsplen = sizeof(*conn_acc);
1344         lsreq->timeout = NVME_FC_LS_TIMEOUT_SEC;
1345
1346         ret = nvme_fc_send_ls_req(ctrl->rport, lsop);
1347         if (ret)
1348                 goto out_free_buffer;
1349
1350         /* process connect LS completion */
1351
1352         /* validate the ACC response */
1353         if (conn_acc->hdr.w0.ls_cmd != FCNVME_LS_ACC)
1354                 fcret = VERR_LSACC;
1355         else if (conn_acc->hdr.desc_list_len !=
1356                         fcnvme_lsdesc_len(sizeof(struct fcnvme_ls_cr_conn_acc)))
1357                 fcret = VERR_CR_CONN_ACC_LEN;
1358         else if (conn_acc->hdr.rqst.desc_tag != cpu_to_be32(FCNVME_LSDESC_RQST))
1359                 fcret = VERR_LSDESC_RQST;
1360         else if (conn_acc->hdr.rqst.desc_len !=
1361                         fcnvme_lsdesc_len(sizeof(struct fcnvme_lsdesc_rqst)))
1362                 fcret = VERR_LSDESC_RQST_LEN;
1363         else if (conn_acc->hdr.rqst.w0.ls_cmd != FCNVME_LS_CREATE_CONNECTION)
1364                 fcret = VERR_CR_CONN;
1365         else if (conn_acc->connectid.desc_tag !=
1366                         cpu_to_be32(FCNVME_LSDESC_CONN_ID))
1367                 fcret = VERR_CONN_ID;
1368         else if (conn_acc->connectid.desc_len !=
1369                         fcnvme_lsdesc_len(sizeof(struct fcnvme_lsdesc_conn_id)))
1370                 fcret = VERR_CONN_ID_LEN;
1371
1372         if (fcret) {
1373                 ret = -EBADF;
1374                 dev_err(ctrl->dev,
1375                         "q %d Create I/O Connection LS failed: %s\n",
1376                         queue->qnum, validation_errors[fcret]);
1377         } else {
1378                 queue->connection_id =
1379                         be64_to_cpu(conn_acc->connectid.connection_id);
1380                 set_bit(NVME_FC_Q_CONNECTED, &queue->flags);
1381         }
1382
1383 out_free_buffer:
1384         kfree(lsop);
1385 out_no_memory:
1386         if (ret)
1387                 dev_err(ctrl->dev,
1388                         "queue %d connect I/O queue failed (%d).\n",
1389                         queue->qnum, ret);
1390         return ret;
1391 }
1392
1393 static void
1394 nvme_fc_disconnect_assoc_done(struct nvmefc_ls_req *lsreq, int status)
1395 {
1396         struct nvmefc_ls_req_op *lsop = ls_req_to_lsop(lsreq);
1397
1398         __nvme_fc_finish_ls_req(lsop);
1399
1400         /* fc-nvme initiator doesn't care about success or failure of cmd */
1401
1402         kfree(lsop);
1403 }
1404
1405 /*
1406  * This routine sends a FC-NVME LS to disconnect (aka terminate)
1407  * the FC-NVME Association.  Terminating the association also
1408  * terminates the FC-NVME connections (per queue, both admin and io
1409  * queues) that are part of the association. E.g. things are torn
1410  * down, and the related FC-NVME Association ID and Connection IDs
1411  * become invalid.
1412  *
1413  * The behavior of the fc-nvme initiator is such that it's
1414  * understanding of the association and connections will implicitly
1415  * be torn down. The action is implicit as it may be due to a loss of
1416  * connectivity with the fc-nvme target, so you may never get a
1417  * response even if you tried.  As such, the action of this routine
1418  * is to asynchronously send the LS, ignore any results of the LS, and
1419  * continue on with terminating the association. If the fc-nvme target
1420  * is present and receives the LS, it too can tear down.
1421  */
1422 static void
1423 nvme_fc_xmt_disconnect_assoc(struct nvme_fc_ctrl *ctrl)
1424 {
1425         struct fcnvme_ls_disconnect_assoc_rqst *discon_rqst;
1426         struct fcnvme_ls_disconnect_assoc_acc *discon_acc;
1427         struct nvmefc_ls_req_op *lsop;
1428         struct nvmefc_ls_req *lsreq;
1429         int ret;
1430
1431         lsop = kzalloc((sizeof(*lsop) +
1432                         sizeof(*discon_rqst) + sizeof(*discon_acc) +
1433                         ctrl->lport->ops->lsrqst_priv_sz), GFP_KERNEL);
1434         if (!lsop) {
1435                 dev_info(ctrl->ctrl.device,
1436                         "NVME-FC{%d}: send Disconnect Association "
1437                         "failed: ENOMEM\n",
1438                         ctrl->cnum);
1439                 return;
1440         }
1441
1442         discon_rqst = (struct fcnvme_ls_disconnect_assoc_rqst *)&lsop[1];
1443         discon_acc = (struct fcnvme_ls_disconnect_assoc_acc *)&discon_rqst[1];
1444         lsreq = &lsop->ls_req;
1445         if (ctrl->lport->ops->lsrqst_priv_sz)
1446                 lsreq->private = (void *)&discon_acc[1];
1447         else
1448                 lsreq->private = NULL;
1449
1450         nvmefc_fmt_lsreq_discon_assoc(lsreq, discon_rqst, discon_acc,
1451                                 ctrl->association_id);
1452
1453         ret = nvme_fc_send_ls_req_async(ctrl->rport, lsop,
1454                                 nvme_fc_disconnect_assoc_done);
1455         if (ret)
1456                 kfree(lsop);
1457 }
1458
1459 static void
1460 nvme_fc_xmt_ls_rsp_done(struct nvmefc_ls_rsp *lsrsp)
1461 {
1462         struct nvmefc_ls_rcv_op *lsop = lsrsp->nvme_fc_private;
1463         struct nvme_fc_rport *rport = lsop->rport;
1464         struct nvme_fc_lport *lport = rport->lport;
1465         unsigned long flags;
1466
1467         spin_lock_irqsave(&rport->lock, flags);
1468         list_del(&lsop->lsrcv_list);
1469         spin_unlock_irqrestore(&rport->lock, flags);
1470
1471         fc_dma_sync_single_for_cpu(lport->dev, lsop->rspdma,
1472                                 sizeof(*lsop->rspbuf), DMA_TO_DEVICE);
1473         fc_dma_unmap_single(lport->dev, lsop->rspdma,
1474                         sizeof(*lsop->rspbuf), DMA_TO_DEVICE);
1475
1476         kfree(lsop);
1477
1478         nvme_fc_rport_put(rport);
1479 }
1480
1481 static void
1482 nvme_fc_xmt_ls_rsp(struct nvmefc_ls_rcv_op *lsop)
1483 {
1484         struct nvme_fc_rport *rport = lsop->rport;
1485         struct nvme_fc_lport *lport = rport->lport;
1486         struct fcnvme_ls_rqst_w0 *w0 = &lsop->rqstbuf->w0;
1487         int ret;
1488
1489         fc_dma_sync_single_for_device(lport->dev, lsop->rspdma,
1490                                   sizeof(*lsop->rspbuf), DMA_TO_DEVICE);
1491
1492         ret = lport->ops->xmt_ls_rsp(&lport->localport, &rport->remoteport,
1493                                      lsop->lsrsp);
1494         if (ret) {
1495                 dev_warn(lport->dev,
1496                         "LLDD rejected LS RSP xmt: LS %d status %d\n",
1497                         w0->ls_cmd, ret);
1498                 nvme_fc_xmt_ls_rsp_done(lsop->lsrsp);
1499                 return;
1500         }
1501 }
1502
1503 static struct nvme_fc_ctrl *
1504 nvme_fc_match_disconn_ls(struct nvme_fc_rport *rport,
1505                       struct nvmefc_ls_rcv_op *lsop)
1506 {
1507         struct fcnvme_ls_disconnect_assoc_rqst *rqst =
1508                                         &lsop->rqstbuf->rq_dis_assoc;
1509         struct nvme_fc_ctrl *ctrl, *ret = NULL;
1510         struct nvmefc_ls_rcv_op *oldls = NULL;
1511         u64 association_id = be64_to_cpu(rqst->associd.association_id);
1512         unsigned long flags;
1513
1514         spin_lock_irqsave(&rport->lock, flags);
1515
1516         list_for_each_entry(ctrl, &rport->ctrl_list, ctrl_list) {
1517                 if (!nvme_fc_ctrl_get(ctrl))
1518                         continue;
1519                 spin_lock(&ctrl->lock);
1520                 if (association_id == ctrl->association_id) {
1521                         oldls = ctrl->rcv_disconn;
1522                         ctrl->rcv_disconn = lsop;
1523                         ret = ctrl;
1524                 }
1525                 spin_unlock(&ctrl->lock);
1526                 if (ret)
1527                         /* leave the ctrl get reference */
1528                         break;
1529                 nvme_fc_ctrl_put(ctrl);
1530         }
1531
1532         spin_unlock_irqrestore(&rport->lock, flags);
1533
1534         /* transmit a response for anything that was pending */
1535         if (oldls) {
1536                 dev_info(rport->lport->dev,
1537                         "NVME-FC{%d}: Multiple Disconnect Association "
1538                         "LS's received\n", ctrl->cnum);
1539                 /* overwrite good response with bogus failure */
1540                 oldls->lsrsp->rsplen = nvme_fc_format_rjt(oldls->rspbuf,
1541                                                 sizeof(*oldls->rspbuf),
1542                                                 rqst->w0.ls_cmd,
1543                                                 FCNVME_RJT_RC_UNAB,
1544                                                 FCNVME_RJT_EXP_NONE, 0);
1545                 nvme_fc_xmt_ls_rsp(oldls);
1546         }
1547
1548         return ret;
1549 }
1550
1551 /*
1552  * returns true to mean LS handled and ls_rsp can be sent
1553  * returns false to defer ls_rsp xmt (will be done as part of
1554  *     association termination)
1555  */
1556 static bool
1557 nvme_fc_ls_disconnect_assoc(struct nvmefc_ls_rcv_op *lsop)
1558 {
1559         struct nvme_fc_rport *rport = lsop->rport;
1560         struct fcnvme_ls_disconnect_assoc_rqst *rqst =
1561                                         &lsop->rqstbuf->rq_dis_assoc;
1562         struct fcnvme_ls_disconnect_assoc_acc *acc =
1563                                         &lsop->rspbuf->rsp_dis_assoc;
1564         struct nvme_fc_ctrl *ctrl = NULL;
1565         int ret = 0;
1566
1567         memset(acc, 0, sizeof(*acc));
1568
1569         ret = nvmefc_vldt_lsreq_discon_assoc(lsop->rqstdatalen, rqst);
1570         if (!ret) {
1571                 /* match an active association */
1572                 ctrl = nvme_fc_match_disconn_ls(rport, lsop);
1573                 if (!ctrl)
1574                         ret = VERR_NO_ASSOC;
1575         }
1576
1577         if (ret) {
1578                 dev_info(rport->lport->dev,
1579                         "Disconnect LS failed: %s\n",
1580                         validation_errors[ret]);
1581                 lsop->lsrsp->rsplen = nvme_fc_format_rjt(acc,
1582                                         sizeof(*acc), rqst->w0.ls_cmd,
1583                                         (ret == VERR_NO_ASSOC) ?
1584                                                 FCNVME_RJT_RC_INV_ASSOC :
1585                                                 FCNVME_RJT_RC_LOGIC,
1586                                         FCNVME_RJT_EXP_NONE, 0);
1587                 return true;
1588         }
1589
1590         /* format an ACCept response */
1591
1592         lsop->lsrsp->rsplen = sizeof(*acc);
1593
1594         nvme_fc_format_rsp_hdr(acc, FCNVME_LS_ACC,
1595                         fcnvme_lsdesc_len(
1596                                 sizeof(struct fcnvme_ls_disconnect_assoc_acc)),
1597                         FCNVME_LS_DISCONNECT_ASSOC);
1598
1599         /*
1600          * the transmit of the response will occur after the exchanges
1601          * for the association have been ABTS'd by
1602          * nvme_fc_delete_association().
1603          */
1604
1605         /* fail the association */
1606         nvme_fc_error_recovery(ctrl, "Disconnect Association LS received");
1607
1608         /* release the reference taken by nvme_fc_match_disconn_ls() */
1609         nvme_fc_ctrl_put(ctrl);
1610
1611         return false;
1612 }
1613
1614 /*
1615  * Actual Processing routine for received FC-NVME LS Requests from the LLD
1616  * returns true if a response should be sent afterward, false if rsp will
1617  * be sent asynchronously.
1618  */
1619 static bool
1620 nvme_fc_handle_ls_rqst(struct nvmefc_ls_rcv_op *lsop)
1621 {
1622         struct fcnvme_ls_rqst_w0 *w0 = &lsop->rqstbuf->w0;
1623         bool ret = true;
1624
1625         lsop->lsrsp->nvme_fc_private = lsop;
1626         lsop->lsrsp->rspbuf = lsop->rspbuf;
1627         lsop->lsrsp->rspdma = lsop->rspdma;
1628         lsop->lsrsp->done = nvme_fc_xmt_ls_rsp_done;
1629         /* Be preventative. handlers will later set to valid length */
1630         lsop->lsrsp->rsplen = 0;
1631
1632         /*
1633          * handlers:
1634          *   parse request input, execute the request, and format the
1635          *   LS response
1636          */
1637         switch (w0->ls_cmd) {
1638         case FCNVME_LS_DISCONNECT_ASSOC:
1639                 ret = nvme_fc_ls_disconnect_assoc(lsop);
1640                 break;
1641         case FCNVME_LS_DISCONNECT_CONN:
1642                 lsop->lsrsp->rsplen = nvme_fc_format_rjt(lsop->rspbuf,
1643                                 sizeof(*lsop->rspbuf), w0->ls_cmd,
1644                                 FCNVME_RJT_RC_UNSUP, FCNVME_RJT_EXP_NONE, 0);
1645                 break;
1646         case FCNVME_LS_CREATE_ASSOCIATION:
1647         case FCNVME_LS_CREATE_CONNECTION:
1648                 lsop->lsrsp->rsplen = nvme_fc_format_rjt(lsop->rspbuf,
1649                                 sizeof(*lsop->rspbuf), w0->ls_cmd,
1650                                 FCNVME_RJT_RC_LOGIC, FCNVME_RJT_EXP_NONE, 0);
1651                 break;
1652         default:
1653                 lsop->lsrsp->rsplen = nvme_fc_format_rjt(lsop->rspbuf,
1654                                 sizeof(*lsop->rspbuf), w0->ls_cmd,
1655                                 FCNVME_RJT_RC_INVAL, FCNVME_RJT_EXP_NONE, 0);
1656                 break;
1657         }
1658
1659         return(ret);
1660 }
1661
1662 static void
1663 nvme_fc_handle_ls_rqst_work(struct work_struct *work)
1664 {
1665         struct nvme_fc_rport *rport =
1666                 container_of(work, struct nvme_fc_rport, lsrcv_work);
1667         struct fcnvme_ls_rqst_w0 *w0;
1668         struct nvmefc_ls_rcv_op *lsop;
1669         unsigned long flags;
1670         bool sendrsp;
1671
1672 restart:
1673         sendrsp = true;
1674         spin_lock_irqsave(&rport->lock, flags);
1675         list_for_each_entry(lsop, &rport->ls_rcv_list, lsrcv_list) {
1676                 if (lsop->handled)
1677                         continue;
1678
1679                 lsop->handled = true;
1680                 if (rport->remoteport.port_state == FC_OBJSTATE_ONLINE) {
1681                         spin_unlock_irqrestore(&rport->lock, flags);
1682                         sendrsp = nvme_fc_handle_ls_rqst(lsop);
1683                 } else {
1684                         spin_unlock_irqrestore(&rport->lock, flags);
1685                         w0 = &lsop->rqstbuf->w0;
1686                         lsop->lsrsp->rsplen = nvme_fc_format_rjt(
1687                                                 lsop->rspbuf,
1688                                                 sizeof(*lsop->rspbuf),
1689                                                 w0->ls_cmd,
1690                                                 FCNVME_RJT_RC_UNAB,
1691                                                 FCNVME_RJT_EXP_NONE, 0);
1692                 }
1693                 if (sendrsp)
1694                         nvme_fc_xmt_ls_rsp(lsop);
1695                 goto restart;
1696         }
1697         spin_unlock_irqrestore(&rport->lock, flags);
1698 }
1699
1700 /**
1701  * nvme_fc_rcv_ls_req - transport entry point called by an LLDD
1702  *                       upon the reception of a NVME LS request.
1703  *
1704  * The nvme-fc layer will copy payload to an internal structure for
1705  * processing.  As such, upon completion of the routine, the LLDD may
1706  * immediately free/reuse the LS request buffer passed in the call.
1707  *
1708  * If this routine returns error, the LLDD should abort the exchange.
1709  *
1710  * @remoteport: pointer to the (registered) remote port that the LS
1711  *              was received from. The remoteport is associated with
1712  *              a specific localport.
1713  * @lsrsp:      pointer to a nvmefc_ls_rsp response structure to be
1714  *              used to reference the exchange corresponding to the LS
1715  *              when issuing an ls response.
1716  * @lsreqbuf:   pointer to the buffer containing the LS Request
1717  * @lsreqbuf_len: length, in bytes, of the received LS request
1718  */
1719 int
1720 nvme_fc_rcv_ls_req(struct nvme_fc_remote_port *portptr,
1721                         struct nvmefc_ls_rsp *lsrsp,
1722                         void *lsreqbuf, u32 lsreqbuf_len)
1723 {
1724         struct nvme_fc_rport *rport = remoteport_to_rport(portptr);
1725         struct nvme_fc_lport *lport = rport->lport;
1726         struct fcnvme_ls_rqst_w0 *w0 = (struct fcnvme_ls_rqst_w0 *)lsreqbuf;
1727         struct nvmefc_ls_rcv_op *lsop;
1728         unsigned long flags;
1729         int ret;
1730
1731         nvme_fc_rport_get(rport);
1732
1733         /* validate there's a routine to transmit a response */
1734         if (!lport->ops->xmt_ls_rsp) {
1735                 dev_info(lport->dev,
1736                         "RCV %s LS failed: no LLDD xmt_ls_rsp\n",
1737                         (w0->ls_cmd <= NVME_FC_LAST_LS_CMD_VALUE) ?
1738                                 nvmefc_ls_names[w0->ls_cmd] : "");
1739                 ret = -EINVAL;
1740                 goto out_put;
1741         }
1742
1743         if (lsreqbuf_len > sizeof(union nvmefc_ls_requests)) {
1744                 dev_info(lport->dev,
1745                         "RCV %s LS failed: payload too large\n",
1746                         (w0->ls_cmd <= NVME_FC_LAST_LS_CMD_VALUE) ?
1747                                 nvmefc_ls_names[w0->ls_cmd] : "");
1748                 ret = -E2BIG;
1749                 goto out_put;
1750         }
1751
1752         lsop = kzalloc(sizeof(*lsop) +
1753                         sizeof(union nvmefc_ls_requests) +
1754                         sizeof(union nvmefc_ls_responses),
1755                         GFP_KERNEL);
1756         if (!lsop) {
1757                 dev_info(lport->dev,
1758                         "RCV %s LS failed: No memory\n",
1759                         (w0->ls_cmd <= NVME_FC_LAST_LS_CMD_VALUE) ?
1760                                 nvmefc_ls_names[w0->ls_cmd] : "");
1761                 ret = -ENOMEM;
1762                 goto out_put;
1763         }
1764         lsop->rqstbuf = (union nvmefc_ls_requests *)&lsop[1];
1765         lsop->rspbuf = (union nvmefc_ls_responses *)&lsop->rqstbuf[1];
1766
1767         lsop->rspdma = fc_dma_map_single(lport->dev, lsop->rspbuf,
1768                                         sizeof(*lsop->rspbuf),
1769                                         DMA_TO_DEVICE);
1770         if (fc_dma_mapping_error(lport->dev, lsop->rspdma)) {
1771                 dev_info(lport->dev,
1772                         "RCV %s LS failed: DMA mapping failure\n",
1773                         (w0->ls_cmd <= NVME_FC_LAST_LS_CMD_VALUE) ?
1774                                 nvmefc_ls_names[w0->ls_cmd] : "");
1775                 ret = -EFAULT;
1776                 goto out_free;
1777         }
1778
1779         lsop->rport = rport;
1780         lsop->lsrsp = lsrsp;
1781
1782         memcpy(lsop->rqstbuf, lsreqbuf, lsreqbuf_len);
1783         lsop->rqstdatalen = lsreqbuf_len;
1784
1785         spin_lock_irqsave(&rport->lock, flags);
1786         if (rport->remoteport.port_state != FC_OBJSTATE_ONLINE) {
1787                 spin_unlock_irqrestore(&rport->lock, flags);
1788                 ret = -ENOTCONN;
1789                 goto out_unmap;
1790         }
1791         list_add_tail(&lsop->lsrcv_list, &rport->ls_rcv_list);
1792         spin_unlock_irqrestore(&rport->lock, flags);
1793
1794         schedule_work(&rport->lsrcv_work);
1795
1796         return 0;
1797
1798 out_unmap:
1799         fc_dma_unmap_single(lport->dev, lsop->rspdma,
1800                         sizeof(*lsop->rspbuf), DMA_TO_DEVICE);
1801 out_free:
1802         kfree(lsop);
1803 out_put:
1804         nvme_fc_rport_put(rport);
1805         return ret;
1806 }
1807 EXPORT_SYMBOL_GPL(nvme_fc_rcv_ls_req);
1808
1809
1810 /* *********************** NVME Ctrl Routines **************************** */
1811
1812 static void
1813 __nvme_fc_exit_request(struct nvme_fc_ctrl *ctrl,
1814                 struct nvme_fc_fcp_op *op)
1815 {
1816         fc_dma_unmap_single(ctrl->lport->dev, op->fcp_req.rspdma,
1817                                 sizeof(op->rsp_iu), DMA_FROM_DEVICE);
1818         fc_dma_unmap_single(ctrl->lport->dev, op->fcp_req.cmddma,
1819                                 sizeof(op->cmd_iu), DMA_TO_DEVICE);
1820
1821         atomic_set(&op->state, FCPOP_STATE_UNINIT);
1822 }
1823
1824 static void
1825 nvme_fc_exit_request(struct blk_mq_tag_set *set, struct request *rq,
1826                 unsigned int hctx_idx)
1827 {
1828         struct nvme_fc_fcp_op *op = blk_mq_rq_to_pdu(rq);
1829
1830         return __nvme_fc_exit_request(set->driver_data, op);
1831 }
1832
1833 static int
1834 __nvme_fc_abort_op(struct nvme_fc_ctrl *ctrl, struct nvme_fc_fcp_op *op)
1835 {
1836         unsigned long flags;
1837         int opstate;
1838
1839         spin_lock_irqsave(&ctrl->lock, flags);
1840         opstate = atomic_xchg(&op->state, FCPOP_STATE_ABORTED);
1841         if (opstate != FCPOP_STATE_ACTIVE)
1842                 atomic_set(&op->state, opstate);
1843         else if (test_bit(FCCTRL_TERMIO, &ctrl->flags)) {
1844                 op->flags |= FCOP_FLAGS_TERMIO;
1845                 ctrl->iocnt++;
1846         }
1847         spin_unlock_irqrestore(&ctrl->lock, flags);
1848
1849         if (opstate != FCPOP_STATE_ACTIVE)
1850                 return -ECANCELED;
1851
1852         ctrl->lport->ops->fcp_abort(&ctrl->lport->localport,
1853                                         &ctrl->rport->remoteport,
1854                                         op->queue->lldd_handle,
1855                                         &op->fcp_req);
1856
1857         return 0;
1858 }
1859
1860 static void
1861 nvme_fc_abort_aen_ops(struct nvme_fc_ctrl *ctrl)
1862 {
1863         struct nvme_fc_fcp_op *aen_op = ctrl->aen_ops;
1864         int i;
1865
1866         /* ensure we've initialized the ops once */
1867         if (!(aen_op->flags & FCOP_FLAGS_AEN))
1868                 return;
1869
1870         for (i = 0; i < NVME_NR_AEN_COMMANDS; i++, aen_op++)
1871                 __nvme_fc_abort_op(ctrl, aen_op);
1872 }
1873
1874 static inline void
1875 __nvme_fc_fcpop_chk_teardowns(struct nvme_fc_ctrl *ctrl,
1876                 struct nvme_fc_fcp_op *op, int opstate)
1877 {
1878         unsigned long flags;
1879
1880         if (opstate == FCPOP_STATE_ABORTED) {
1881                 spin_lock_irqsave(&ctrl->lock, flags);
1882                 if (test_bit(FCCTRL_TERMIO, &ctrl->flags) &&
1883                     op->flags & FCOP_FLAGS_TERMIO) {
1884                         if (!--ctrl->iocnt)
1885                                 wake_up(&ctrl->ioabort_wait);
1886                 }
1887                 spin_unlock_irqrestore(&ctrl->lock, flags);
1888         }
1889 }
1890
1891 static void
1892 nvme_fc_fcpio_done(struct nvmefc_fcp_req *req)
1893 {
1894         struct nvme_fc_fcp_op *op = fcp_req_to_fcp_op(req);
1895         struct request *rq = op->rq;
1896         struct nvmefc_fcp_req *freq = &op->fcp_req;
1897         struct nvme_fc_ctrl *ctrl = op->ctrl;
1898         struct nvme_fc_queue *queue = op->queue;
1899         struct nvme_completion *cqe = &op->rsp_iu.cqe;
1900         struct nvme_command *sqe = &op->cmd_iu.sqe;
1901         __le16 status = cpu_to_le16(NVME_SC_SUCCESS << 1);
1902         union nvme_result result;
1903         bool terminate_assoc = true;
1904         int opstate;
1905
1906         /*
1907          * WARNING:
1908          * The current linux implementation of a nvme controller
1909          * allocates a single tag set for all io queues and sizes
1910          * the io queues to fully hold all possible tags. Thus, the
1911          * implementation does not reference or care about the sqhd
1912          * value as it never needs to use the sqhd/sqtail pointers
1913          * for submission pacing.
1914          *
1915          * This affects the FC-NVME implementation in two ways:
1916          * 1) As the value doesn't matter, we don't need to waste
1917          *    cycles extracting it from ERSPs and stamping it in the
1918          *    cases where the transport fabricates CQEs on successful
1919          *    completions.
1920          * 2) The FC-NVME implementation requires that delivery of
1921          *    ERSP completions are to go back to the nvme layer in order
1922          *    relative to the rsn, such that the sqhd value will always
1923          *    be "in order" for the nvme layer. As the nvme layer in
1924          *    linux doesn't care about sqhd, there's no need to return
1925          *    them in order.
1926          *
1927          * Additionally:
1928          * As the core nvme layer in linux currently does not look at
1929          * every field in the cqe - in cases where the FC transport must
1930          * fabricate a CQE, the following fields will not be set as they
1931          * are not referenced:
1932          *      cqe.sqid,  cqe.sqhd,  cqe.command_id
1933          *
1934          * Failure or error of an individual i/o, in a transport
1935          * detected fashion unrelated to the nvme completion status,
1936          * potentially cause the initiator and target sides to get out
1937          * of sync on SQ head/tail (aka outstanding io count allowed).
1938          * Per FC-NVME spec, failure of an individual command requires
1939          * the connection to be terminated, which in turn requires the
1940          * association to be terminated.
1941          */
1942
1943         opstate = atomic_xchg(&op->state, FCPOP_STATE_COMPLETE);
1944
1945         fc_dma_sync_single_for_cpu(ctrl->lport->dev, op->fcp_req.rspdma,
1946                                 sizeof(op->rsp_iu), DMA_FROM_DEVICE);
1947
1948         if (opstate == FCPOP_STATE_ABORTED)
1949                 status = cpu_to_le16(NVME_SC_HOST_PATH_ERROR << 1);
1950         else if (freq->status) {
1951                 status = cpu_to_le16(NVME_SC_HOST_PATH_ERROR << 1);
1952                 dev_info(ctrl->ctrl.device,
1953                         "NVME-FC{%d}: io failed due to lldd error %d\n",
1954                         ctrl->cnum, freq->status);
1955         }
1956
1957         /*
1958          * For the linux implementation, if we have an unsuccesful
1959          * status, they blk-mq layer can typically be called with the
1960          * non-zero status and the content of the cqe isn't important.
1961          */
1962         if (status)
1963                 goto done;
1964
1965         /*
1966          * command completed successfully relative to the wire
1967          * protocol. However, validate anything received and
1968          * extract the status and result from the cqe (create it
1969          * where necessary).
1970          */
1971
1972         switch (freq->rcv_rsplen) {
1973
1974         case 0:
1975         case NVME_FC_SIZEOF_ZEROS_RSP:
1976                 /*
1977                  * No response payload or 12 bytes of payload (which
1978                  * should all be zeros) are considered successful and
1979                  * no payload in the CQE by the transport.
1980                  */
1981                 if (freq->transferred_length !=
1982                     be32_to_cpu(op->cmd_iu.data_len)) {
1983                         status = cpu_to_le16(NVME_SC_HOST_PATH_ERROR << 1);
1984                         dev_info(ctrl->ctrl.device,
1985                                 "NVME-FC{%d}: io failed due to bad transfer "
1986                                 "length: %d vs expected %d\n",
1987                                 ctrl->cnum, freq->transferred_length,
1988                                 be32_to_cpu(op->cmd_iu.data_len));
1989                         goto done;
1990                 }
1991                 result.u64 = 0;
1992                 break;
1993
1994         case sizeof(struct nvme_fc_ersp_iu):
1995                 /*
1996                  * The ERSP IU contains a full completion with CQE.
1997                  * Validate ERSP IU and look at cqe.
1998                  */
1999                 if (unlikely(be16_to_cpu(op->rsp_iu.iu_len) !=
2000                                         (freq->rcv_rsplen / 4) ||
2001                              be32_to_cpu(op->rsp_iu.xfrd_len) !=
2002                                         freq->transferred_length ||
2003                              op->rsp_iu.ersp_result ||
2004                              sqe->common.command_id != cqe->command_id)) {
2005                         status = cpu_to_le16(NVME_SC_HOST_PATH_ERROR << 1);
2006                         dev_info(ctrl->ctrl.device,
2007                                 "NVME-FC{%d}: io failed due to bad NVMe_ERSP: "
2008                                 "iu len %d, xfr len %d vs %d, status code "
2009                                 "%d, cmdid %d vs %d\n",
2010                                 ctrl->cnum, be16_to_cpu(op->rsp_iu.iu_len),
2011                                 be32_to_cpu(op->rsp_iu.xfrd_len),
2012                                 freq->transferred_length,
2013                                 op->rsp_iu.ersp_result,
2014                                 sqe->common.command_id,
2015                                 cqe->command_id);
2016                         goto done;
2017                 }
2018                 result = cqe->result;
2019                 status = cqe->status;
2020                 break;
2021
2022         default:
2023                 status = cpu_to_le16(NVME_SC_HOST_PATH_ERROR << 1);
2024                 dev_info(ctrl->ctrl.device,
2025                         "NVME-FC{%d}: io failed due to odd NVMe_xRSP iu "
2026                         "len %d\n",
2027                         ctrl->cnum, freq->rcv_rsplen);
2028                 goto done;
2029         }
2030
2031         terminate_assoc = false;
2032
2033 done:
2034         if (op->flags & FCOP_FLAGS_AEN) {
2035                 nvme_complete_async_event(&queue->ctrl->ctrl, status, &result);
2036                 __nvme_fc_fcpop_chk_teardowns(ctrl, op, opstate);
2037                 atomic_set(&op->state, FCPOP_STATE_IDLE);
2038                 op->flags = FCOP_FLAGS_AEN;     /* clear other flags */
2039                 nvme_fc_ctrl_put(ctrl);
2040                 goto check_error;
2041         }
2042
2043         __nvme_fc_fcpop_chk_teardowns(ctrl, op, opstate);
2044         if (!nvme_try_complete_req(rq, status, result))
2045                 nvme_fc_complete_rq(rq);
2046
2047 check_error:
2048         if (terminate_assoc)
2049                 nvme_fc_error_recovery(ctrl, "transport detected io error");
2050 }
2051
2052 static int
2053 __nvme_fc_init_request(struct nvme_fc_ctrl *ctrl,
2054                 struct nvme_fc_queue *queue, struct nvme_fc_fcp_op *op,
2055                 struct request *rq, u32 rqno)
2056 {
2057         struct nvme_fcp_op_w_sgl *op_w_sgl =
2058                 container_of(op, typeof(*op_w_sgl), op);
2059         struct nvme_fc_cmd_iu *cmdiu = &op->cmd_iu;
2060         int ret = 0;
2061
2062         memset(op, 0, sizeof(*op));
2063         op->fcp_req.cmdaddr = &op->cmd_iu;
2064         op->fcp_req.cmdlen = sizeof(op->cmd_iu);
2065         op->fcp_req.rspaddr = &op->rsp_iu;
2066         op->fcp_req.rsplen = sizeof(op->rsp_iu);
2067         op->fcp_req.done = nvme_fc_fcpio_done;
2068         op->ctrl = ctrl;
2069         op->queue = queue;
2070         op->rq = rq;
2071         op->rqno = rqno;
2072
2073         cmdiu->format_id = NVME_CMD_FORMAT_ID;
2074         cmdiu->fc_id = NVME_CMD_FC_ID;
2075         cmdiu->iu_len = cpu_to_be16(sizeof(*cmdiu) / sizeof(u32));
2076         if (queue->qnum)
2077                 cmdiu->rsv_cat = fccmnd_set_cat_css(0,
2078                                         (NVME_CC_CSS_NVM >> NVME_CC_CSS_SHIFT));
2079         else
2080                 cmdiu->rsv_cat = fccmnd_set_cat_admin(0);
2081
2082         op->fcp_req.cmddma = fc_dma_map_single(ctrl->lport->dev,
2083                                 &op->cmd_iu, sizeof(op->cmd_iu), DMA_TO_DEVICE);
2084         if (fc_dma_mapping_error(ctrl->lport->dev, op->fcp_req.cmddma)) {
2085                 dev_err(ctrl->dev,
2086                         "FCP Op failed - cmdiu dma mapping failed.\n");
2087                 ret = -EFAULT;
2088                 goto out_on_error;
2089         }
2090
2091         op->fcp_req.rspdma = fc_dma_map_single(ctrl->lport->dev,
2092                                 &op->rsp_iu, sizeof(op->rsp_iu),
2093                                 DMA_FROM_DEVICE);
2094         if (fc_dma_mapping_error(ctrl->lport->dev, op->fcp_req.rspdma)) {
2095                 dev_err(ctrl->dev,
2096                         "FCP Op failed - rspiu dma mapping failed.\n");
2097                 ret = -EFAULT;
2098         }
2099
2100         atomic_set(&op->state, FCPOP_STATE_IDLE);
2101 out_on_error:
2102         return ret;
2103 }
2104
2105 static int
2106 nvme_fc_init_request(struct blk_mq_tag_set *set, struct request *rq,
2107                 unsigned int hctx_idx, unsigned int numa_node)
2108 {
2109         struct nvme_fc_ctrl *ctrl = set->driver_data;
2110         struct nvme_fcp_op_w_sgl *op = blk_mq_rq_to_pdu(rq);
2111         int queue_idx = (set == &ctrl->tag_set) ? hctx_idx + 1 : 0;
2112         struct nvme_fc_queue *queue = &ctrl->queues[queue_idx];
2113         int res;
2114
2115         res = __nvme_fc_init_request(ctrl, queue, &op->op, rq, queue->rqcnt++);
2116         if (res)
2117                 return res;
2118         op->op.fcp_req.first_sgl = op->sgl;
2119         op->op.fcp_req.private = &op->priv[0];
2120         nvme_req(rq)->ctrl = &ctrl->ctrl;
2121         return res;
2122 }
2123
2124 static int
2125 nvme_fc_init_aen_ops(struct nvme_fc_ctrl *ctrl)
2126 {
2127         struct nvme_fc_fcp_op *aen_op;
2128         struct nvme_fc_cmd_iu *cmdiu;
2129         struct nvme_command *sqe;
2130         void *private = NULL;
2131         int i, ret;
2132
2133         aen_op = ctrl->aen_ops;
2134         for (i = 0; i < NVME_NR_AEN_COMMANDS; i++, aen_op++) {
2135                 if (ctrl->lport->ops->fcprqst_priv_sz) {
2136                         private = kzalloc(ctrl->lport->ops->fcprqst_priv_sz,
2137                                                 GFP_KERNEL);
2138                         if (!private)
2139                                 return -ENOMEM;
2140                 }
2141
2142                 cmdiu = &aen_op->cmd_iu;
2143                 sqe = &cmdiu->sqe;
2144                 ret = __nvme_fc_init_request(ctrl, &ctrl->queues[0],
2145                                 aen_op, (struct request *)NULL,
2146                                 (NVME_AQ_BLK_MQ_DEPTH + i));
2147                 if (ret) {
2148                         kfree(private);
2149                         return ret;
2150                 }
2151
2152                 aen_op->flags = FCOP_FLAGS_AEN;
2153                 aen_op->fcp_req.private = private;
2154
2155                 memset(sqe, 0, sizeof(*sqe));
2156                 sqe->common.opcode = nvme_admin_async_event;
2157                 /* Note: core layer may overwrite the sqe.command_id value */
2158                 sqe->common.command_id = NVME_AQ_BLK_MQ_DEPTH + i;
2159         }
2160         return 0;
2161 }
2162
2163 static void
2164 nvme_fc_term_aen_ops(struct nvme_fc_ctrl *ctrl)
2165 {
2166         struct nvme_fc_fcp_op *aen_op;
2167         int i;
2168
2169         cancel_work_sync(&ctrl->ctrl.async_event_work);
2170         aen_op = ctrl->aen_ops;
2171         for (i = 0; i < NVME_NR_AEN_COMMANDS; i++, aen_op++) {
2172                 __nvme_fc_exit_request(ctrl, aen_op);
2173
2174                 kfree(aen_op->fcp_req.private);
2175                 aen_op->fcp_req.private = NULL;
2176         }
2177 }
2178
2179 static inline void
2180 __nvme_fc_init_hctx(struct blk_mq_hw_ctx *hctx, struct nvme_fc_ctrl *ctrl,
2181                 unsigned int qidx)
2182 {
2183         struct nvme_fc_queue *queue = &ctrl->queues[qidx];
2184
2185         hctx->driver_data = queue;
2186         queue->hctx = hctx;
2187 }
2188
2189 static int
2190 nvme_fc_init_hctx(struct blk_mq_hw_ctx *hctx, void *data,
2191                 unsigned int hctx_idx)
2192 {
2193         struct nvme_fc_ctrl *ctrl = data;
2194
2195         __nvme_fc_init_hctx(hctx, ctrl, hctx_idx + 1);
2196
2197         return 0;
2198 }
2199
2200 static int
2201 nvme_fc_init_admin_hctx(struct blk_mq_hw_ctx *hctx, void *data,
2202                 unsigned int hctx_idx)
2203 {
2204         struct nvme_fc_ctrl *ctrl = data;
2205
2206         __nvme_fc_init_hctx(hctx, ctrl, hctx_idx);
2207
2208         return 0;
2209 }
2210
2211 static void
2212 nvme_fc_init_queue(struct nvme_fc_ctrl *ctrl, int idx)
2213 {
2214         struct nvme_fc_queue *queue;
2215
2216         queue = &ctrl->queues[idx];
2217         memset(queue, 0, sizeof(*queue));
2218         queue->ctrl = ctrl;
2219         queue->qnum = idx;
2220         atomic_set(&queue->csn, 0);
2221         queue->dev = ctrl->dev;
2222
2223         if (idx > 0)
2224                 queue->cmnd_capsule_len = ctrl->ctrl.ioccsz * 16;
2225         else
2226                 queue->cmnd_capsule_len = sizeof(struct nvme_command);
2227
2228         /*
2229          * Considered whether we should allocate buffers for all SQEs
2230          * and CQEs and dma map them - mapping their respective entries
2231          * into the request structures (kernel vm addr and dma address)
2232          * thus the driver could use the buffers/mappings directly.
2233          * It only makes sense if the LLDD would use them for its
2234          * messaging api. It's very unlikely most adapter api's would use
2235          * a native NVME sqe/cqe. More reasonable if FC-NVME IU payload
2236          * structures were used instead.
2237          */
2238 }
2239
2240 /*
2241  * This routine terminates a queue at the transport level.
2242  * The transport has already ensured that all outstanding ios on
2243  * the queue have been terminated.
2244  * The transport will send a Disconnect LS request to terminate
2245  * the queue's connection. Termination of the admin queue will also
2246  * terminate the association at the target.
2247  */
2248 static void
2249 nvme_fc_free_queue(struct nvme_fc_queue *queue)
2250 {
2251         if (!test_and_clear_bit(NVME_FC_Q_CONNECTED, &queue->flags))
2252                 return;
2253
2254         clear_bit(NVME_FC_Q_LIVE, &queue->flags);
2255         /*
2256          * Current implementation never disconnects a single queue.
2257          * It always terminates a whole association. So there is never
2258          * a disconnect(queue) LS sent to the target.
2259          */
2260
2261         queue->connection_id = 0;
2262         atomic_set(&queue->csn, 0);
2263 }
2264
2265 static void
2266 __nvme_fc_delete_hw_queue(struct nvme_fc_ctrl *ctrl,
2267         struct nvme_fc_queue *queue, unsigned int qidx)
2268 {
2269         if (ctrl->lport->ops->delete_queue)
2270                 ctrl->lport->ops->delete_queue(&ctrl->lport->localport, qidx,
2271                                 queue->lldd_handle);
2272         queue->lldd_handle = NULL;
2273 }
2274
2275 static void
2276 nvme_fc_free_io_queues(struct nvme_fc_ctrl *ctrl)
2277 {
2278         int i;
2279
2280         for (i = 1; i < ctrl->ctrl.queue_count; i++)
2281                 nvme_fc_free_queue(&ctrl->queues[i]);
2282 }
2283
2284 static int
2285 __nvme_fc_create_hw_queue(struct nvme_fc_ctrl *ctrl,
2286         struct nvme_fc_queue *queue, unsigned int qidx, u16 qsize)
2287 {
2288         int ret = 0;
2289
2290         queue->lldd_handle = NULL;
2291         if (ctrl->lport->ops->create_queue)
2292                 ret = ctrl->lport->ops->create_queue(&ctrl->lport->localport,
2293                                 qidx, qsize, &queue->lldd_handle);
2294
2295         return ret;
2296 }
2297
2298 static void
2299 nvme_fc_delete_hw_io_queues(struct nvme_fc_ctrl *ctrl)
2300 {
2301         struct nvme_fc_queue *queue = &ctrl->queues[ctrl->ctrl.queue_count - 1];
2302         int i;
2303
2304         for (i = ctrl->ctrl.queue_count - 1; i >= 1; i--, queue--)
2305                 __nvme_fc_delete_hw_queue(ctrl, queue, i);
2306 }
2307
2308 static int
2309 nvme_fc_create_hw_io_queues(struct nvme_fc_ctrl *ctrl, u16 qsize)
2310 {
2311         struct nvme_fc_queue *queue = &ctrl->queues[1];
2312         int i, ret;
2313
2314         for (i = 1; i < ctrl->ctrl.queue_count; i++, queue++) {
2315                 ret = __nvme_fc_create_hw_queue(ctrl, queue, i, qsize);
2316                 if (ret)
2317                         goto delete_queues;
2318         }
2319
2320         return 0;
2321
2322 delete_queues:
2323         for (; i > 0; i--)
2324                 __nvme_fc_delete_hw_queue(ctrl, &ctrl->queues[i], i);
2325         return ret;
2326 }
2327
2328 static int
2329 nvme_fc_connect_io_queues(struct nvme_fc_ctrl *ctrl, u16 qsize)
2330 {
2331         int i, ret = 0;
2332
2333         for (i = 1; i < ctrl->ctrl.queue_count; i++) {
2334                 ret = nvme_fc_connect_queue(ctrl, &ctrl->queues[i], qsize,
2335                                         (qsize / 5));
2336                 if (ret)
2337                         break;
2338                 ret = nvmf_connect_io_queue(&ctrl->ctrl, i, false);
2339                 if (ret)
2340                         break;
2341
2342                 set_bit(NVME_FC_Q_LIVE, &ctrl->queues[i].flags);
2343         }
2344
2345         return ret;
2346 }
2347
2348 static void
2349 nvme_fc_init_io_queues(struct nvme_fc_ctrl *ctrl)
2350 {
2351         int i;
2352
2353         for (i = 1; i < ctrl->ctrl.queue_count; i++)
2354                 nvme_fc_init_queue(ctrl, i);
2355 }
2356
2357 static void
2358 nvme_fc_ctrl_free(struct kref *ref)
2359 {
2360         struct nvme_fc_ctrl *ctrl =
2361                 container_of(ref, struct nvme_fc_ctrl, ref);
2362         unsigned long flags;
2363
2364         if (ctrl->ctrl.tagset) {
2365                 blk_cleanup_queue(ctrl->ctrl.connect_q);
2366                 blk_mq_free_tag_set(&ctrl->tag_set);
2367         }
2368
2369         /* remove from rport list */
2370         spin_lock_irqsave(&ctrl->rport->lock, flags);
2371         list_del(&ctrl->ctrl_list);
2372         spin_unlock_irqrestore(&ctrl->rport->lock, flags);
2373
2374         blk_mq_unquiesce_queue(ctrl->ctrl.admin_q);
2375         blk_cleanup_queue(ctrl->ctrl.admin_q);
2376         blk_cleanup_queue(ctrl->ctrl.fabrics_q);
2377         blk_mq_free_tag_set(&ctrl->admin_tag_set);
2378
2379         kfree(ctrl->queues);
2380
2381         put_device(ctrl->dev);
2382         nvme_fc_rport_put(ctrl->rport);
2383
2384         ida_simple_remove(&nvme_fc_ctrl_cnt, ctrl->cnum);
2385         if (ctrl->ctrl.opts)
2386                 nvmf_free_options(ctrl->ctrl.opts);
2387         kfree(ctrl);
2388 }
2389
2390 static void
2391 nvme_fc_ctrl_put(struct nvme_fc_ctrl *ctrl)
2392 {
2393         kref_put(&ctrl->ref, nvme_fc_ctrl_free);
2394 }
2395
2396 static int
2397 nvme_fc_ctrl_get(struct nvme_fc_ctrl *ctrl)
2398 {
2399         return kref_get_unless_zero(&ctrl->ref);
2400 }
2401
2402 /*
2403  * All accesses from nvme core layer done - can now free the
2404  * controller. Called after last nvme_put_ctrl() call
2405  */
2406 static void
2407 nvme_fc_nvme_ctrl_freed(struct nvme_ctrl *nctrl)
2408 {
2409         struct nvme_fc_ctrl *ctrl = to_fc_ctrl(nctrl);
2410
2411         WARN_ON(nctrl != &ctrl->ctrl);
2412
2413         nvme_fc_ctrl_put(ctrl);
2414 }
2415
2416 /*
2417  * This routine is used by the transport when it needs to find active
2418  * io on a queue that is to be terminated. The transport uses
2419  * blk_mq_tagset_busy_itr() to find the busy requests, which then invoke
2420  * this routine to kill them on a 1 by 1 basis.
2421  *
2422  * As FC allocates FC exchange for each io, the transport must contact
2423  * the LLDD to terminate the exchange, thus releasing the FC exchange.
2424  * After terminating the exchange the LLDD will call the transport's
2425  * normal io done path for the request, but it will have an aborted
2426  * status. The done path will return the io request back to the block
2427  * layer with an error status.
2428  */
2429 static bool
2430 nvme_fc_terminate_exchange(struct request *req, void *data, bool reserved)
2431 {
2432         struct nvme_ctrl *nctrl = data;
2433         struct nvme_fc_ctrl *ctrl = to_fc_ctrl(nctrl);
2434         struct nvme_fc_fcp_op *op = blk_mq_rq_to_pdu(req);
2435
2436         __nvme_fc_abort_op(ctrl, op);
2437         return true;
2438 }
2439
2440 /*
2441  * This routine runs through all outstanding commands on the association
2442  * and aborts them.  This routine is typically be called by the
2443  * delete_association routine. It is also called due to an error during
2444  * reconnect. In that scenario, it is most likely a command that initializes
2445  * the controller, including fabric Connect commands on io queues, that
2446  * may have timed out or failed thus the io must be killed for the connect
2447  * thread to see the error.
2448  */
2449 static void
2450 __nvme_fc_abort_outstanding_ios(struct nvme_fc_ctrl *ctrl, bool start_queues)
2451 {
2452         /*
2453          * If io queues are present, stop them and terminate all outstanding
2454          * ios on them. As FC allocates FC exchange for each io, the
2455          * transport must contact the LLDD to terminate the exchange,
2456          * thus releasing the FC exchange. We use blk_mq_tagset_busy_itr()
2457          * to tell us what io's are busy and invoke a transport routine
2458          * to kill them with the LLDD.  After terminating the exchange
2459          * the LLDD will call the transport's normal io done path, but it
2460          * will have an aborted status. The done path will return the
2461          * io requests back to the block layer as part of normal completions
2462          * (but with error status).
2463          */
2464         if (ctrl->ctrl.queue_count > 1) {
2465                 nvme_stop_queues(&ctrl->ctrl);
2466                 blk_mq_tagset_busy_iter(&ctrl->tag_set,
2467                                 nvme_fc_terminate_exchange, &ctrl->ctrl);
2468                 blk_mq_tagset_wait_completed_request(&ctrl->tag_set);
2469                 if (start_queues)
2470                         nvme_start_queues(&ctrl->ctrl);
2471         }
2472
2473         /*
2474          * Other transports, which don't have link-level contexts bound
2475          * to sqe's, would try to gracefully shutdown the controller by
2476          * writing the registers for shutdown and polling (call
2477          * nvme_shutdown_ctrl()). Given a bunch of i/o was potentially
2478          * just aborted and we will wait on those contexts, and given
2479          * there was no indication of how live the controlelr is on the
2480          * link, don't send more io to create more contexts for the
2481          * shutdown. Let the controller fail via keepalive failure if
2482          * its still present.
2483          */
2484
2485         /*
2486          * clean up the admin queue. Same thing as above.
2487          */
2488         blk_mq_quiesce_queue(ctrl->ctrl.admin_q);
2489         blk_mq_tagset_busy_iter(&ctrl->admin_tag_set,
2490                                 nvme_fc_terminate_exchange, &ctrl->ctrl);
2491         blk_mq_tagset_wait_completed_request(&ctrl->admin_tag_set);
2492 }
2493
2494 static void
2495 nvme_fc_error_recovery(struct nvme_fc_ctrl *ctrl, char *errmsg)
2496 {
2497         /*
2498          * if an error (io timeout, etc) while (re)connecting, the remote
2499          * port requested terminating of the association (disconnect_ls)
2500          * or an error (timeout or abort) occurred on an io while creating
2501          * the controller.  Abort any ios on the association and let the
2502          * create_association error path resolve things.
2503          */
2504         if (ctrl->ctrl.state == NVME_CTRL_CONNECTING) {
2505                 __nvme_fc_abort_outstanding_ios(ctrl, true);
2506                 set_bit(ASSOC_FAILED, &ctrl->flags);
2507                 return;
2508         }
2509
2510         /* Otherwise, only proceed if in LIVE state - e.g. on first error */
2511         if (ctrl->ctrl.state != NVME_CTRL_LIVE)
2512                 return;
2513
2514         dev_warn(ctrl->ctrl.device,
2515                 "NVME-FC{%d}: transport association event: %s\n",
2516                 ctrl->cnum, errmsg);
2517         dev_warn(ctrl->ctrl.device,
2518                 "NVME-FC{%d}: resetting controller\n", ctrl->cnum);
2519
2520         nvme_reset_ctrl(&ctrl->ctrl);
2521 }
2522
2523 static enum blk_eh_timer_return
2524 nvme_fc_timeout(struct request *rq, bool reserved)
2525 {
2526         struct nvme_fc_fcp_op *op = blk_mq_rq_to_pdu(rq);
2527         struct nvme_fc_ctrl *ctrl = op->ctrl;
2528         struct nvme_fc_cmd_iu *cmdiu = &op->cmd_iu;
2529         struct nvme_command *sqe = &cmdiu->sqe;
2530
2531         /*
2532          * Attempt to abort the offending command. Command completion
2533          * will detect the aborted io and will fail the connection.
2534          */
2535         dev_info(ctrl->ctrl.device,
2536                 "NVME-FC{%d.%d}: io timeout: opcode %d fctype %d w10/11: "
2537                 "x%08x/x%08x\n",
2538                 ctrl->cnum, op->queue->qnum, sqe->common.opcode,
2539                 sqe->connect.fctype, sqe->common.cdw10, sqe->common.cdw11);
2540         if (__nvme_fc_abort_op(ctrl, op))
2541                 nvme_fc_error_recovery(ctrl, "io timeout abort failed");
2542
2543         /*
2544          * the io abort has been initiated. Have the reset timer
2545          * restarted and the abort completion will complete the io
2546          * shortly. Avoids a synchronous wait while the abort finishes.
2547          */
2548         return BLK_EH_RESET_TIMER;
2549 }
2550
2551 static int
2552 nvme_fc_map_data(struct nvme_fc_ctrl *ctrl, struct request *rq,
2553                 struct nvme_fc_fcp_op *op)
2554 {
2555         struct nvmefc_fcp_req *freq = &op->fcp_req;
2556         int ret;
2557
2558         freq->sg_cnt = 0;
2559
2560         if (!blk_rq_nr_phys_segments(rq))
2561                 return 0;
2562
2563         freq->sg_table.sgl = freq->first_sgl;
2564         ret = sg_alloc_table_chained(&freq->sg_table,
2565                         blk_rq_nr_phys_segments(rq), freq->sg_table.sgl,
2566                         NVME_INLINE_SG_CNT);
2567         if (ret)
2568                 return -ENOMEM;
2569
2570         op->nents = blk_rq_map_sg(rq->q, rq, freq->sg_table.sgl);
2571         WARN_ON(op->nents > blk_rq_nr_phys_segments(rq));
2572         freq->sg_cnt = fc_dma_map_sg(ctrl->lport->dev, freq->sg_table.sgl,
2573                                 op->nents, rq_dma_dir(rq));
2574         if (unlikely(freq->sg_cnt <= 0)) {
2575                 sg_free_table_chained(&freq->sg_table, NVME_INLINE_SG_CNT);
2576                 freq->sg_cnt = 0;
2577                 return -EFAULT;
2578         }
2579
2580         /*
2581          * TODO: blk_integrity_rq(rq)  for DIF
2582          */
2583         return 0;
2584 }
2585
2586 static void
2587 nvme_fc_unmap_data(struct nvme_fc_ctrl *ctrl, struct request *rq,
2588                 struct nvme_fc_fcp_op *op)
2589 {
2590         struct nvmefc_fcp_req *freq = &op->fcp_req;
2591
2592         if (!freq->sg_cnt)
2593                 return;
2594
2595         fc_dma_unmap_sg(ctrl->lport->dev, freq->sg_table.sgl, op->nents,
2596                         rq_dma_dir(rq));
2597
2598         sg_free_table_chained(&freq->sg_table, NVME_INLINE_SG_CNT);
2599
2600         freq->sg_cnt = 0;
2601 }
2602
2603 /*
2604  * In FC, the queue is a logical thing. At transport connect, the target
2605  * creates its "queue" and returns a handle that is to be given to the
2606  * target whenever it posts something to the corresponding SQ.  When an
2607  * SQE is sent on a SQ, FC effectively considers the SQE, or rather the
2608  * command contained within the SQE, an io, and assigns a FC exchange
2609  * to it. The SQE and the associated SQ handle are sent in the initial
2610  * CMD IU sents on the exchange. All transfers relative to the io occur
2611  * as part of the exchange.  The CQE is the last thing for the io,
2612  * which is transferred (explicitly or implicitly) with the RSP IU
2613  * sent on the exchange. After the CQE is received, the FC exchange is
2614  * terminaed and the Exchange may be used on a different io.
2615  *
2616  * The transport to LLDD api has the transport making a request for a
2617  * new fcp io request to the LLDD. The LLDD then allocates a FC exchange
2618  * resource and transfers the command. The LLDD will then process all
2619  * steps to complete the io. Upon completion, the transport done routine
2620  * is called.
2621  *
2622  * So - while the operation is outstanding to the LLDD, there is a link
2623  * level FC exchange resource that is also outstanding. This must be
2624  * considered in all cleanup operations.
2625  */
2626 static blk_status_t
2627 nvme_fc_start_fcp_op(struct nvme_fc_ctrl *ctrl, struct nvme_fc_queue *queue,
2628         struct nvme_fc_fcp_op *op, u32 data_len,
2629         enum nvmefc_fcp_datadir io_dir)
2630 {
2631         struct nvme_fc_cmd_iu *cmdiu = &op->cmd_iu;
2632         struct nvme_command *sqe = &cmdiu->sqe;
2633         int ret, opstate;
2634
2635         /*
2636          * before attempting to send the io, check to see if we believe
2637          * the target device is present
2638          */
2639         if (ctrl->rport->remoteport.port_state != FC_OBJSTATE_ONLINE)
2640                 return BLK_STS_RESOURCE;
2641
2642         if (!nvme_fc_ctrl_get(ctrl))
2643                 return BLK_STS_IOERR;
2644
2645         /* format the FC-NVME CMD IU and fcp_req */
2646         cmdiu->connection_id = cpu_to_be64(queue->connection_id);
2647         cmdiu->data_len = cpu_to_be32(data_len);
2648         switch (io_dir) {
2649         case NVMEFC_FCP_WRITE:
2650                 cmdiu->flags = FCNVME_CMD_FLAGS_WRITE;
2651                 break;
2652         case NVMEFC_FCP_READ:
2653                 cmdiu->flags = FCNVME_CMD_FLAGS_READ;
2654                 break;
2655         case NVMEFC_FCP_NODATA:
2656                 cmdiu->flags = 0;
2657                 break;
2658         }
2659         op->fcp_req.payload_length = data_len;
2660         op->fcp_req.io_dir = io_dir;
2661         op->fcp_req.transferred_length = 0;
2662         op->fcp_req.rcv_rsplen = 0;
2663         op->fcp_req.status = NVME_SC_SUCCESS;
2664         op->fcp_req.sqid = cpu_to_le16(queue->qnum);
2665
2666         /*
2667          * validate per fabric rules, set fields mandated by fabric spec
2668          * as well as those by FC-NVME spec.
2669          */
2670         WARN_ON_ONCE(sqe->common.metadata);
2671         sqe->common.flags |= NVME_CMD_SGL_METABUF;
2672
2673         /*
2674          * format SQE DPTR field per FC-NVME rules:
2675          *    type=0x5     Transport SGL Data Block Descriptor
2676          *    subtype=0xA  Transport-specific value
2677          *    address=0
2678          *    length=length of the data series
2679          */
2680         sqe->rw.dptr.sgl.type = (NVME_TRANSPORT_SGL_DATA_DESC << 4) |
2681                                         NVME_SGL_FMT_TRANSPORT_A;
2682         sqe->rw.dptr.sgl.length = cpu_to_le32(data_len);
2683         sqe->rw.dptr.sgl.addr = 0;
2684
2685         if (!(op->flags & FCOP_FLAGS_AEN)) {
2686                 ret = nvme_fc_map_data(ctrl, op->rq, op);
2687                 if (ret < 0) {
2688                         nvme_cleanup_cmd(op->rq);
2689                         nvme_fc_ctrl_put(ctrl);
2690                         if (ret == -ENOMEM || ret == -EAGAIN)
2691                                 return BLK_STS_RESOURCE;
2692                         return BLK_STS_IOERR;
2693                 }
2694         }
2695
2696         fc_dma_sync_single_for_device(ctrl->lport->dev, op->fcp_req.cmddma,
2697                                   sizeof(op->cmd_iu), DMA_TO_DEVICE);
2698
2699         atomic_set(&op->state, FCPOP_STATE_ACTIVE);
2700
2701         if (!(op->flags & FCOP_FLAGS_AEN))
2702                 blk_mq_start_request(op->rq);
2703
2704         cmdiu->csn = cpu_to_be32(atomic_inc_return(&queue->csn));
2705         ret = ctrl->lport->ops->fcp_io(&ctrl->lport->localport,
2706                                         &ctrl->rport->remoteport,
2707                                         queue->lldd_handle, &op->fcp_req);
2708
2709         if (ret) {
2710                 /*
2711                  * If the lld fails to send the command is there an issue with
2712                  * the csn value?  If the command that fails is the Connect,
2713                  * no - as the connection won't be live.  If it is a command
2714                  * post-connect, it's possible a gap in csn may be created.
2715                  * Does this matter?  As Linux initiators don't send fused
2716                  * commands, no.  The gap would exist, but as there's nothing
2717                  * that depends on csn order to be delivered on the target
2718                  * side, it shouldn't hurt.  It would be difficult for a
2719                  * target to even detect the csn gap as it has no idea when the
2720                  * cmd with the csn was supposed to arrive.
2721                  */
2722                 opstate = atomic_xchg(&op->state, FCPOP_STATE_COMPLETE);
2723                 __nvme_fc_fcpop_chk_teardowns(ctrl, op, opstate);
2724
2725                 if (!(op->flags & FCOP_FLAGS_AEN)) {
2726                         nvme_fc_unmap_data(ctrl, op->rq, op);
2727                         nvme_cleanup_cmd(op->rq);
2728                 }
2729
2730                 nvme_fc_ctrl_put(ctrl);
2731
2732                 if (ctrl->rport->remoteport.port_state == FC_OBJSTATE_ONLINE &&
2733                                 ret != -EBUSY)
2734                         return BLK_STS_IOERR;
2735
2736                 return BLK_STS_RESOURCE;
2737         }
2738
2739         return BLK_STS_OK;
2740 }
2741
2742 static blk_status_t
2743 nvme_fc_queue_rq(struct blk_mq_hw_ctx *hctx,
2744                         const struct blk_mq_queue_data *bd)
2745 {
2746         struct nvme_ns *ns = hctx->queue->queuedata;
2747         struct nvme_fc_queue *queue = hctx->driver_data;
2748         struct nvme_fc_ctrl *ctrl = queue->ctrl;
2749         struct request *rq = bd->rq;
2750         struct nvme_fc_fcp_op *op = blk_mq_rq_to_pdu(rq);
2751         struct nvme_fc_cmd_iu *cmdiu = &op->cmd_iu;
2752         struct nvme_command *sqe = &cmdiu->sqe;
2753         enum nvmefc_fcp_datadir io_dir;
2754         bool queue_ready = test_bit(NVME_FC_Q_LIVE, &queue->flags);
2755         u32 data_len;
2756         blk_status_t ret;
2757
2758         if (ctrl->rport->remoteport.port_state != FC_OBJSTATE_ONLINE ||
2759             !nvmf_check_ready(&queue->ctrl->ctrl, rq, queue_ready))
2760                 return nvmf_fail_nonready_command(&queue->ctrl->ctrl, rq);
2761
2762         ret = nvme_setup_cmd(ns, rq, sqe);
2763         if (ret)
2764                 return ret;
2765
2766         /*
2767          * nvme core doesn't quite treat the rq opaquely. Commands such
2768          * as WRITE ZEROES will return a non-zero rq payload_bytes yet
2769          * there is no actual payload to be transferred.
2770          * To get it right, key data transmission on there being 1 or
2771          * more physical segments in the sg list. If there is no
2772          * physical segments, there is no payload.
2773          */
2774         if (blk_rq_nr_phys_segments(rq)) {
2775                 data_len = blk_rq_payload_bytes(rq);
2776                 io_dir = ((rq_data_dir(rq) == WRITE) ?
2777                                         NVMEFC_FCP_WRITE : NVMEFC_FCP_READ);
2778         } else {
2779                 data_len = 0;
2780                 io_dir = NVMEFC_FCP_NODATA;
2781         }
2782
2783
2784         return nvme_fc_start_fcp_op(ctrl, queue, op, data_len, io_dir);
2785 }
2786
2787 static void
2788 nvme_fc_submit_async_event(struct nvme_ctrl *arg)
2789 {
2790         struct nvme_fc_ctrl *ctrl = to_fc_ctrl(arg);
2791         struct nvme_fc_fcp_op *aen_op;
2792         blk_status_t ret;
2793
2794         if (test_bit(FCCTRL_TERMIO, &ctrl->flags))
2795                 return;
2796
2797         aen_op = &ctrl->aen_ops[0];
2798
2799         ret = nvme_fc_start_fcp_op(ctrl, aen_op->queue, aen_op, 0,
2800                                         NVMEFC_FCP_NODATA);
2801         if (ret)
2802                 dev_err(ctrl->ctrl.device,
2803                         "failed async event work\n");
2804 }
2805
2806 static void
2807 nvme_fc_complete_rq(struct request *rq)
2808 {
2809         struct nvme_fc_fcp_op *op = blk_mq_rq_to_pdu(rq);
2810         struct nvme_fc_ctrl *ctrl = op->ctrl;
2811
2812         atomic_set(&op->state, FCPOP_STATE_IDLE);
2813         op->flags &= ~FCOP_FLAGS_TERMIO;
2814
2815         nvme_fc_unmap_data(ctrl, rq, op);
2816         nvme_complete_rq(rq);
2817         nvme_fc_ctrl_put(ctrl);
2818 }
2819
2820
2821 static const struct blk_mq_ops nvme_fc_mq_ops = {
2822         .queue_rq       = nvme_fc_queue_rq,
2823         .complete       = nvme_fc_complete_rq,
2824         .init_request   = nvme_fc_init_request,
2825         .exit_request   = nvme_fc_exit_request,
2826         .init_hctx      = nvme_fc_init_hctx,
2827         .timeout        = nvme_fc_timeout,
2828 };
2829
2830 static int
2831 nvme_fc_create_io_queues(struct nvme_fc_ctrl *ctrl)
2832 {
2833         struct nvmf_ctrl_options *opts = ctrl->ctrl.opts;
2834         unsigned int nr_io_queues;
2835         int ret;
2836
2837         nr_io_queues = min(min(opts->nr_io_queues, num_online_cpus()),
2838                                 ctrl->lport->ops->max_hw_queues);
2839         ret = nvme_set_queue_count(&ctrl->ctrl, &nr_io_queues);
2840         if (ret) {
2841                 dev_info(ctrl->ctrl.device,
2842                         "set_queue_count failed: %d\n", ret);
2843                 return ret;
2844         }
2845
2846         ctrl->ctrl.queue_count = nr_io_queues + 1;
2847         if (!nr_io_queues)
2848                 return 0;
2849
2850         nvme_fc_init_io_queues(ctrl);
2851
2852         memset(&ctrl->tag_set, 0, sizeof(ctrl->tag_set));
2853         ctrl->tag_set.ops = &nvme_fc_mq_ops;
2854         ctrl->tag_set.queue_depth = ctrl->ctrl.opts->queue_size;
2855         ctrl->tag_set.reserved_tags = 1; /* fabric connect */
2856         ctrl->tag_set.numa_node = ctrl->ctrl.numa_node;
2857         ctrl->tag_set.flags = BLK_MQ_F_SHOULD_MERGE;
2858         ctrl->tag_set.cmd_size =
2859                 struct_size((struct nvme_fcp_op_w_sgl *)NULL, priv,
2860                             ctrl->lport->ops->fcprqst_priv_sz);
2861         ctrl->tag_set.driver_data = ctrl;
2862         ctrl->tag_set.nr_hw_queues = ctrl->ctrl.queue_count - 1;
2863         ctrl->tag_set.timeout = NVME_IO_TIMEOUT;
2864
2865         ret = blk_mq_alloc_tag_set(&ctrl->tag_set);
2866         if (ret)
2867                 return ret;
2868
2869         ctrl->ctrl.tagset = &ctrl->tag_set;
2870
2871         ctrl->ctrl.connect_q = blk_mq_init_queue(&ctrl->tag_set);
2872         if (IS_ERR(ctrl->ctrl.connect_q)) {
2873                 ret = PTR_ERR(ctrl->ctrl.connect_q);
2874                 goto out_free_tag_set;
2875         }
2876
2877         ret = nvme_fc_create_hw_io_queues(ctrl, ctrl->ctrl.sqsize + 1);
2878         if (ret)
2879                 goto out_cleanup_blk_queue;
2880
2881         ret = nvme_fc_connect_io_queues(ctrl, ctrl->ctrl.sqsize + 1);
2882         if (ret)
2883                 goto out_delete_hw_queues;
2884
2885         ctrl->ioq_live = true;
2886
2887         return 0;
2888
2889 out_delete_hw_queues:
2890         nvme_fc_delete_hw_io_queues(ctrl);
2891 out_cleanup_blk_queue:
2892         blk_cleanup_queue(ctrl->ctrl.connect_q);
2893 out_free_tag_set:
2894         blk_mq_free_tag_set(&ctrl->tag_set);
2895         nvme_fc_free_io_queues(ctrl);
2896
2897         /* force put free routine to ignore io queues */
2898         ctrl->ctrl.tagset = NULL;
2899
2900         return ret;
2901 }
2902
2903 static int
2904 nvme_fc_recreate_io_queues(struct nvme_fc_ctrl *ctrl)
2905 {
2906         struct nvmf_ctrl_options *opts = ctrl->ctrl.opts;
2907         u32 prior_ioq_cnt = ctrl->ctrl.queue_count - 1;
2908         unsigned int nr_io_queues;
2909         int ret;
2910
2911         nr_io_queues = min(min(opts->nr_io_queues, num_online_cpus()),
2912                                 ctrl->lport->ops->max_hw_queues);
2913         ret = nvme_set_queue_count(&ctrl->ctrl, &nr_io_queues);
2914         if (ret) {
2915                 dev_info(ctrl->ctrl.device,
2916                         "set_queue_count failed: %d\n", ret);
2917                 return ret;
2918         }
2919
2920         if (!nr_io_queues && prior_ioq_cnt) {
2921                 dev_info(ctrl->ctrl.device,
2922                         "Fail Reconnect: At least 1 io queue "
2923                         "required (was %d)\n", prior_ioq_cnt);
2924                 return -ENOSPC;
2925         }
2926
2927         ctrl->ctrl.queue_count = nr_io_queues + 1;
2928         /* check for io queues existing */
2929         if (ctrl->ctrl.queue_count == 1)
2930                 return 0;
2931
2932         ret = nvme_fc_create_hw_io_queues(ctrl, ctrl->ctrl.sqsize + 1);
2933         if (ret)
2934                 goto out_free_io_queues;
2935
2936         ret = nvme_fc_connect_io_queues(ctrl, ctrl->ctrl.sqsize + 1);
2937         if (ret)
2938                 goto out_delete_hw_queues;
2939
2940         if (prior_ioq_cnt != nr_io_queues) {
2941                 dev_info(ctrl->ctrl.device,
2942                         "reconnect: revising io queue count from %d to %d\n",
2943                         prior_ioq_cnt, nr_io_queues);
2944                 nvme_wait_freeze(&ctrl->ctrl);
2945                 blk_mq_update_nr_hw_queues(&ctrl->tag_set, nr_io_queues);
2946                 nvme_unfreeze(&ctrl->ctrl);
2947         }
2948
2949         return 0;
2950
2951 out_delete_hw_queues:
2952         nvme_fc_delete_hw_io_queues(ctrl);
2953 out_free_io_queues:
2954         nvme_fc_free_io_queues(ctrl);
2955         return ret;
2956 }
2957
2958 static void
2959 nvme_fc_rport_active_on_lport(struct nvme_fc_rport *rport)
2960 {
2961         struct nvme_fc_lport *lport = rport->lport;
2962
2963         atomic_inc(&lport->act_rport_cnt);
2964 }
2965
2966 static void
2967 nvme_fc_rport_inactive_on_lport(struct nvme_fc_rport *rport)
2968 {
2969         struct nvme_fc_lport *lport = rport->lport;
2970         u32 cnt;
2971
2972         cnt = atomic_dec_return(&lport->act_rport_cnt);
2973         if (cnt == 0 && lport->localport.port_state == FC_OBJSTATE_DELETED)
2974                 lport->ops->localport_delete(&lport->localport);
2975 }
2976
2977 static int
2978 nvme_fc_ctlr_active_on_rport(struct nvme_fc_ctrl *ctrl)
2979 {
2980         struct nvme_fc_rport *rport = ctrl->rport;
2981         u32 cnt;
2982
2983         if (test_and_set_bit(ASSOC_ACTIVE, &ctrl->flags))
2984                 return 1;
2985
2986         cnt = atomic_inc_return(&rport->act_ctrl_cnt);
2987         if (cnt == 1)
2988                 nvme_fc_rport_active_on_lport(rport);
2989
2990         return 0;
2991 }
2992
2993 static int
2994 nvme_fc_ctlr_inactive_on_rport(struct nvme_fc_ctrl *ctrl)
2995 {
2996         struct nvme_fc_rport *rport = ctrl->rport;
2997         struct nvme_fc_lport *lport = rport->lport;
2998         u32 cnt;
2999
3000         /* clearing of ctrl->flags ASSOC_ACTIVE bit is in association delete */
3001
3002         cnt = atomic_dec_return(&rport->act_ctrl_cnt);
3003         if (cnt == 0) {
3004                 if (rport->remoteport.port_state == FC_OBJSTATE_DELETED)
3005                         lport->ops->remoteport_delete(&rport->remoteport);
3006                 nvme_fc_rport_inactive_on_lport(rport);
3007         }
3008
3009         return 0;
3010 }
3011
3012 /*
3013  * This routine restarts the controller on the host side, and
3014  * on the link side, recreates the controller association.
3015  */
3016 static int
3017 nvme_fc_create_association(struct nvme_fc_ctrl *ctrl)
3018 {
3019         struct nvmf_ctrl_options *opts = ctrl->ctrl.opts;
3020         struct nvmefc_ls_rcv_op *disls = NULL;
3021         unsigned long flags;
3022         int ret;
3023         bool changed;
3024
3025         ++ctrl->ctrl.nr_reconnects;
3026
3027         if (ctrl->rport->remoteport.port_state != FC_OBJSTATE_ONLINE)
3028                 return -ENODEV;
3029
3030         if (nvme_fc_ctlr_active_on_rport(ctrl))
3031                 return -ENOTUNIQ;
3032
3033         dev_info(ctrl->ctrl.device,
3034                 "NVME-FC{%d}: create association : host wwpn 0x%016llx "
3035                 " rport wwpn 0x%016llx: NQN \"%s\"\n",
3036                 ctrl->cnum, ctrl->lport->localport.port_name,
3037                 ctrl->rport->remoteport.port_name, ctrl->ctrl.opts->subsysnqn);
3038
3039         clear_bit(ASSOC_FAILED, &ctrl->flags);
3040
3041         /*
3042          * Create the admin queue
3043          */
3044
3045         ret = __nvme_fc_create_hw_queue(ctrl, &ctrl->queues[0], 0,
3046                                 NVME_AQ_DEPTH);
3047         if (ret)
3048                 goto out_free_queue;
3049
3050         ret = nvme_fc_connect_admin_queue(ctrl, &ctrl->queues[0],
3051                                 NVME_AQ_DEPTH, (NVME_AQ_DEPTH / 4));
3052         if (ret)
3053                 goto out_delete_hw_queue;
3054
3055         ret = nvmf_connect_admin_queue(&ctrl->ctrl);
3056         if (ret)
3057                 goto out_disconnect_admin_queue;
3058
3059         set_bit(NVME_FC_Q_LIVE, &ctrl->queues[0].flags);
3060
3061         /*
3062          * Check controller capabilities
3063          *
3064          * todo:- add code to check if ctrl attributes changed from
3065          * prior connection values
3066          */
3067
3068         ret = nvme_enable_ctrl(&ctrl->ctrl);
3069         if (ret || test_bit(ASSOC_FAILED, &ctrl->flags))
3070                 goto out_disconnect_admin_queue;
3071
3072         ctrl->ctrl.max_segments = ctrl->lport->ops->max_sgl_segments;
3073         ctrl->ctrl.max_hw_sectors = ctrl->ctrl.max_segments <<
3074                                                 (ilog2(SZ_4K) - 9);
3075
3076         blk_mq_unquiesce_queue(ctrl->ctrl.admin_q);
3077
3078         ret = nvme_init_identify(&ctrl->ctrl);
3079         if (ret || test_bit(ASSOC_FAILED, &ctrl->flags))
3080                 goto out_disconnect_admin_queue;
3081
3082         /* sanity checks */
3083
3084         /* FC-NVME does not have other data in the capsule */
3085         if (ctrl->ctrl.icdoff) {
3086                 dev_err(ctrl->ctrl.device, "icdoff %d is not supported!\n",
3087                                 ctrl->ctrl.icdoff);
3088                 goto out_disconnect_admin_queue;
3089         }
3090
3091         /* FC-NVME supports normal SGL Data Block Descriptors */
3092
3093         if (opts->queue_size > ctrl->ctrl.maxcmd) {
3094                 /* warn if maxcmd is lower than queue_size */
3095                 dev_warn(ctrl->ctrl.device,
3096                         "queue_size %zu > ctrl maxcmd %u, reducing "
3097                         "to maxcmd\n",
3098                         opts->queue_size, ctrl->ctrl.maxcmd);
3099                 opts->queue_size = ctrl->ctrl.maxcmd;
3100         }
3101
3102         if (opts->queue_size > ctrl->ctrl.sqsize + 1) {
3103                 /* warn if sqsize is lower than queue_size */
3104                 dev_warn(ctrl->ctrl.device,
3105                         "queue_size %zu > ctrl sqsize %u, reducing "
3106                         "to sqsize\n",
3107                         opts->queue_size, ctrl->ctrl.sqsize + 1);
3108                 opts->queue_size = ctrl->ctrl.sqsize + 1;
3109         }
3110
3111         ret = nvme_fc_init_aen_ops(ctrl);
3112         if (ret)
3113                 goto out_term_aen_ops;
3114
3115         /*
3116          * Create the io queues
3117          */
3118
3119         if (ctrl->ctrl.queue_count > 1) {
3120                 if (!ctrl->ioq_live)
3121                         ret = nvme_fc_create_io_queues(ctrl);
3122                 else
3123                         ret = nvme_fc_recreate_io_queues(ctrl);
3124         }
3125         if (ret || test_bit(ASSOC_FAILED, &ctrl->flags))
3126                 goto out_term_aen_ops;
3127
3128         changed = nvme_change_ctrl_state(&ctrl->ctrl, NVME_CTRL_LIVE);
3129
3130         ctrl->ctrl.nr_reconnects = 0;
3131
3132         if (changed)
3133                 nvme_start_ctrl(&ctrl->ctrl);
3134
3135         return 0;       /* Success */
3136
3137 out_term_aen_ops:
3138         nvme_fc_term_aen_ops(ctrl);
3139 out_disconnect_admin_queue:
3140         /* send a Disconnect(association) LS to fc-nvme target */
3141         nvme_fc_xmt_disconnect_assoc(ctrl);
3142         spin_lock_irqsave(&ctrl->lock, flags);
3143         ctrl->association_id = 0;
3144         disls = ctrl->rcv_disconn;
3145         ctrl->rcv_disconn = NULL;
3146         spin_unlock_irqrestore(&ctrl->lock, flags);
3147         if (disls)
3148                 nvme_fc_xmt_ls_rsp(disls);
3149 out_delete_hw_queue:
3150         __nvme_fc_delete_hw_queue(ctrl, &ctrl->queues[0], 0);
3151 out_free_queue:
3152         nvme_fc_free_queue(&ctrl->queues[0]);
3153         clear_bit(ASSOC_ACTIVE, &ctrl->flags);
3154         nvme_fc_ctlr_inactive_on_rport(ctrl);
3155
3156         return ret;
3157 }
3158
3159
3160 /*
3161  * This routine stops operation of the controller on the host side.
3162  * On the host os stack side: Admin and IO queues are stopped,
3163  *   outstanding ios on them terminated via FC ABTS.
3164  * On the link side: the association is terminated.
3165  */
3166 static void
3167 nvme_fc_delete_association(struct nvme_fc_ctrl *ctrl)
3168 {
3169         struct nvmefc_ls_rcv_op *disls = NULL;
3170         unsigned long flags;
3171
3172         if (!test_and_clear_bit(ASSOC_ACTIVE, &ctrl->flags))
3173                 return;
3174
3175         spin_lock_irqsave(&ctrl->lock, flags);
3176         set_bit(FCCTRL_TERMIO, &ctrl->flags);
3177         ctrl->iocnt = 0;
3178         spin_unlock_irqrestore(&ctrl->lock, flags);
3179
3180         __nvme_fc_abort_outstanding_ios(ctrl, false);
3181
3182         /* kill the aens as they are a separate path */
3183         nvme_fc_abort_aen_ops(ctrl);
3184
3185         /* wait for all io that had to be aborted */
3186         spin_lock_irq(&ctrl->lock);
3187         wait_event_lock_irq(ctrl->ioabort_wait, ctrl->iocnt == 0, ctrl->lock);
3188         clear_bit(FCCTRL_TERMIO, &ctrl->flags);
3189         spin_unlock_irq(&ctrl->lock);
3190
3191         nvme_fc_term_aen_ops(ctrl);
3192
3193         /*
3194          * send a Disconnect(association) LS to fc-nvme target
3195          * Note: could have been sent at top of process, but
3196          * cleaner on link traffic if after the aborts complete.
3197          * Note: if association doesn't exist, association_id will be 0
3198          */
3199         if (ctrl->association_id)
3200                 nvme_fc_xmt_disconnect_assoc(ctrl);
3201
3202         spin_lock_irqsave(&ctrl->lock, flags);
3203         ctrl->association_id = 0;
3204         disls = ctrl->rcv_disconn;
3205         ctrl->rcv_disconn = NULL;
3206         spin_unlock_irqrestore(&ctrl->lock, flags);
3207         if (disls)
3208                 /*
3209                  * if a Disconnect Request was waiting for a response, send
3210                  * now that all ABTS's have been issued (and are complete).
3211                  */
3212                 nvme_fc_xmt_ls_rsp(disls);
3213
3214         if (ctrl->ctrl.tagset) {
3215                 nvme_fc_delete_hw_io_queues(ctrl);
3216                 nvme_fc_free_io_queues(ctrl);
3217         }
3218
3219         __nvme_fc_delete_hw_queue(ctrl, &ctrl->queues[0], 0);
3220         nvme_fc_free_queue(&ctrl->queues[0]);
3221
3222         /* re-enable the admin_q so anything new can fast fail */
3223         blk_mq_unquiesce_queue(ctrl->ctrl.admin_q);
3224
3225         /* resume the io queues so that things will fast fail */
3226         nvme_start_queues(&ctrl->ctrl);
3227
3228         nvme_fc_ctlr_inactive_on_rport(ctrl);
3229 }
3230
3231 static void
3232 nvme_fc_delete_ctrl(struct nvme_ctrl *nctrl)
3233 {
3234         struct nvme_fc_ctrl *ctrl = to_fc_ctrl(nctrl);
3235
3236         cancel_delayed_work_sync(&ctrl->connect_work);
3237         /*
3238          * kill the association on the link side.  this will block
3239          * waiting for io to terminate
3240          */
3241         nvme_fc_delete_association(ctrl);
3242 }
3243
3244 static void
3245 nvme_fc_reconnect_or_delete(struct nvme_fc_ctrl *ctrl, int status)
3246 {
3247         struct nvme_fc_rport *rport = ctrl->rport;
3248         struct nvme_fc_remote_port *portptr = &rport->remoteport;
3249         unsigned long recon_delay = ctrl->ctrl.opts->reconnect_delay * HZ;
3250         bool recon = true;
3251
3252         if (ctrl->ctrl.state != NVME_CTRL_CONNECTING)
3253                 return;
3254
3255         if (portptr->port_state == FC_OBJSTATE_ONLINE)
3256                 dev_info(ctrl->ctrl.device,
3257                         "NVME-FC{%d}: reset: Reconnect attempt failed (%d)\n",
3258                         ctrl->cnum, status);
3259         else if (time_after_eq(jiffies, rport->dev_loss_end))
3260                 recon = false;
3261
3262         if (recon && nvmf_should_reconnect(&ctrl->ctrl)) {
3263                 if (portptr->port_state == FC_OBJSTATE_ONLINE)
3264                         dev_info(ctrl->ctrl.device,
3265                                 "NVME-FC{%d}: Reconnect attempt in %ld "
3266                                 "seconds\n",
3267                                 ctrl->cnum, recon_delay / HZ);
3268                 else if (time_after(jiffies + recon_delay, rport->dev_loss_end))
3269                         recon_delay = rport->dev_loss_end - jiffies;
3270
3271                 queue_delayed_work(nvme_wq, &ctrl->connect_work, recon_delay);
3272         } else {
3273                 if (portptr->port_state == FC_OBJSTATE_ONLINE)
3274                         dev_warn(ctrl->ctrl.device,
3275                                 "NVME-FC{%d}: Max reconnect attempts (%d) "
3276                                 "reached.\n",
3277                                 ctrl->cnum, ctrl->ctrl.nr_reconnects);
3278                 else
3279                         dev_warn(ctrl->ctrl.device,
3280                                 "NVME-FC{%d}: dev_loss_tmo (%d) expired "
3281                                 "while waiting for remoteport connectivity.\n",
3282                                 ctrl->cnum, min_t(int, portptr->dev_loss_tmo,
3283                                         (ctrl->ctrl.opts->max_reconnects *
3284                                          ctrl->ctrl.opts->reconnect_delay)));
3285                 WARN_ON(nvme_delete_ctrl(&ctrl->ctrl));
3286         }
3287 }
3288
3289 static void
3290 nvme_fc_reset_ctrl_work(struct work_struct *work)
3291 {
3292         struct nvme_fc_ctrl *ctrl =
3293                 container_of(work, struct nvme_fc_ctrl, ctrl.reset_work);
3294
3295         nvme_stop_ctrl(&ctrl->ctrl);
3296
3297         /* will block will waiting for io to terminate */
3298         nvme_fc_delete_association(ctrl);
3299
3300         if (!nvme_change_ctrl_state(&ctrl->ctrl, NVME_CTRL_CONNECTING))
3301                 dev_err(ctrl->ctrl.device,
3302                         "NVME-FC{%d}: error_recovery: Couldn't change state "
3303                         "to CONNECTING\n", ctrl->cnum);
3304
3305         if (ctrl->rport->remoteport.port_state == FC_OBJSTATE_ONLINE) {
3306                 if (!queue_delayed_work(nvme_wq, &ctrl->connect_work, 0)) {
3307                         dev_err(ctrl->ctrl.device,
3308                                 "NVME-FC{%d}: failed to schedule connect "
3309                                 "after reset\n", ctrl->cnum);
3310                 } else {
3311                         flush_delayed_work(&ctrl->connect_work);
3312                 }
3313         } else {
3314                 nvme_fc_reconnect_or_delete(ctrl, -ENOTCONN);
3315         }
3316 }
3317
3318
3319 static const struct nvme_ctrl_ops nvme_fc_ctrl_ops = {
3320         .name                   = "fc",
3321         .module                 = THIS_MODULE,
3322         .flags                  = NVME_F_FABRICS,
3323         .reg_read32             = nvmf_reg_read32,
3324         .reg_read64             = nvmf_reg_read64,
3325         .reg_write32            = nvmf_reg_write32,
3326         .free_ctrl              = nvme_fc_nvme_ctrl_freed,
3327         .submit_async_event     = nvme_fc_submit_async_event,
3328         .delete_ctrl            = nvme_fc_delete_ctrl,
3329         .get_address            = nvmf_get_address,
3330 };
3331
3332 static void
3333 nvme_fc_connect_ctrl_work(struct work_struct *work)
3334 {
3335         int ret;
3336
3337         struct nvme_fc_ctrl *ctrl =
3338                         container_of(to_delayed_work(work),
3339                                 struct nvme_fc_ctrl, connect_work);
3340
3341         ret = nvme_fc_create_association(ctrl);
3342         if (ret)
3343                 nvme_fc_reconnect_or_delete(ctrl, ret);
3344         else
3345                 dev_info(ctrl->ctrl.device,
3346                         "NVME-FC{%d}: controller connect complete\n",
3347                         ctrl->cnum);
3348 }
3349
3350
3351 static const struct blk_mq_ops nvme_fc_admin_mq_ops = {
3352         .queue_rq       = nvme_fc_queue_rq,
3353         .complete       = nvme_fc_complete_rq,
3354         .init_request   = nvme_fc_init_request,
3355         .exit_request   = nvme_fc_exit_request,
3356         .init_hctx      = nvme_fc_init_admin_hctx,
3357         .timeout        = nvme_fc_timeout,
3358 };
3359
3360
3361 /*
3362  * Fails a controller request if it matches an existing controller
3363  * (association) with the same tuple:
3364  * <Host NQN, Host ID, local FC port, remote FC port, SUBSYS NQN>
3365  *
3366  * The ports don't need to be compared as they are intrinsically
3367  * already matched by the port pointers supplied.
3368  */
3369 static bool
3370 nvme_fc_existing_controller(struct nvme_fc_rport *rport,
3371                 struct nvmf_ctrl_options *opts)
3372 {
3373         struct nvme_fc_ctrl *ctrl;
3374         unsigned long flags;
3375         bool found = false;
3376
3377         spin_lock_irqsave(&rport->lock, flags);
3378         list_for_each_entry(ctrl, &rport->ctrl_list, ctrl_list) {
3379                 found = nvmf_ctlr_matches_baseopts(&ctrl->ctrl, opts);
3380                 if (found)
3381                         break;
3382         }
3383         spin_unlock_irqrestore(&rport->lock, flags);
3384
3385         return found;
3386 }
3387
3388 static struct nvme_ctrl *
3389 nvme_fc_init_ctrl(struct device *dev, struct nvmf_ctrl_options *opts,
3390         struct nvme_fc_lport *lport, struct nvme_fc_rport *rport)
3391 {
3392         struct nvme_fc_ctrl *ctrl;
3393         unsigned long flags;
3394         int ret, idx, ctrl_loss_tmo;
3395
3396         if (!(rport->remoteport.port_role &
3397             (FC_PORT_ROLE_NVME_DISCOVERY | FC_PORT_ROLE_NVME_TARGET))) {
3398                 ret = -EBADR;
3399                 goto out_fail;
3400         }
3401
3402         if (!opts->duplicate_connect &&
3403             nvme_fc_existing_controller(rport, opts)) {
3404                 ret = -EALREADY;
3405                 goto out_fail;
3406         }
3407
3408         ctrl = kzalloc(sizeof(*ctrl), GFP_KERNEL);
3409         if (!ctrl) {
3410                 ret = -ENOMEM;
3411                 goto out_fail;
3412         }
3413
3414         idx = ida_simple_get(&nvme_fc_ctrl_cnt, 0, 0, GFP_KERNEL);
3415         if (idx < 0) {
3416                 ret = -ENOSPC;
3417                 goto out_free_ctrl;
3418         }
3419
3420         /*
3421          * if ctrl_loss_tmo is being enforced and the default reconnect delay
3422          * is being used, change to a shorter reconnect delay for FC.
3423          */
3424         if (opts->max_reconnects != -1 &&
3425             opts->reconnect_delay == NVMF_DEF_RECONNECT_DELAY &&
3426             opts->reconnect_delay > NVME_FC_DEFAULT_RECONNECT_TMO) {
3427                 ctrl_loss_tmo = opts->max_reconnects * opts->reconnect_delay;
3428                 opts->reconnect_delay = NVME_FC_DEFAULT_RECONNECT_TMO;
3429                 opts->max_reconnects = DIV_ROUND_UP(ctrl_loss_tmo,
3430                                                 opts->reconnect_delay);
3431         }
3432
3433         ctrl->ctrl.opts = opts;
3434         ctrl->ctrl.nr_reconnects = 0;
3435         if (lport->dev)
3436                 ctrl->ctrl.numa_node = dev_to_node(lport->dev);
3437         else
3438                 ctrl->ctrl.numa_node = NUMA_NO_NODE;
3439         INIT_LIST_HEAD(&ctrl->ctrl_list);
3440         ctrl->lport = lport;
3441         ctrl->rport = rport;
3442         ctrl->dev = lport->dev;
3443         ctrl->cnum = idx;
3444         ctrl->ioq_live = false;
3445         init_waitqueue_head(&ctrl->ioabort_wait);
3446
3447         get_device(ctrl->dev);
3448         kref_init(&ctrl->ref);
3449
3450         INIT_WORK(&ctrl->ctrl.reset_work, nvme_fc_reset_ctrl_work);
3451         INIT_DELAYED_WORK(&ctrl->connect_work, nvme_fc_connect_ctrl_work);
3452         spin_lock_init(&ctrl->lock);
3453
3454         /* io queue count */
3455         ctrl->ctrl.queue_count = min_t(unsigned int,
3456                                 opts->nr_io_queues,
3457                                 lport->ops->max_hw_queues);
3458         ctrl->ctrl.queue_count++;       /* +1 for admin queue */
3459
3460         ctrl->ctrl.sqsize = opts->queue_size - 1;
3461         ctrl->ctrl.kato = opts->kato;
3462         ctrl->ctrl.cntlid = 0xffff;
3463
3464         ret = -ENOMEM;
3465         ctrl->queues = kcalloc(ctrl->ctrl.queue_count,
3466                                 sizeof(struct nvme_fc_queue), GFP_KERNEL);
3467         if (!ctrl->queues)
3468                 goto out_free_ida;
3469
3470         nvme_fc_init_queue(ctrl, 0);
3471
3472         memset(&ctrl->admin_tag_set, 0, sizeof(ctrl->admin_tag_set));
3473         ctrl->admin_tag_set.ops = &nvme_fc_admin_mq_ops;
3474         ctrl->admin_tag_set.queue_depth = NVME_AQ_MQ_TAG_DEPTH;
3475         ctrl->admin_tag_set.reserved_tags = 2; /* fabric connect + Keep-Alive */
3476         ctrl->admin_tag_set.numa_node = ctrl->ctrl.numa_node;
3477         ctrl->admin_tag_set.cmd_size =
3478                 struct_size((struct nvme_fcp_op_w_sgl *)NULL, priv,
3479                             ctrl->lport->ops->fcprqst_priv_sz);
3480         ctrl->admin_tag_set.driver_data = ctrl;
3481         ctrl->admin_tag_set.nr_hw_queues = 1;
3482         ctrl->admin_tag_set.timeout = NVME_ADMIN_TIMEOUT;
3483         ctrl->admin_tag_set.flags = BLK_MQ_F_NO_SCHED;
3484
3485         ret = blk_mq_alloc_tag_set(&ctrl->admin_tag_set);
3486         if (ret)
3487                 goto out_free_queues;
3488         ctrl->ctrl.admin_tagset = &ctrl->admin_tag_set;
3489
3490         ctrl->ctrl.fabrics_q = blk_mq_init_queue(&ctrl->admin_tag_set);
3491         if (IS_ERR(ctrl->ctrl.fabrics_q)) {
3492                 ret = PTR_ERR(ctrl->ctrl.fabrics_q);
3493                 goto out_free_admin_tag_set;
3494         }
3495
3496         ctrl->ctrl.admin_q = blk_mq_init_queue(&ctrl->admin_tag_set);
3497         if (IS_ERR(ctrl->ctrl.admin_q)) {
3498                 ret = PTR_ERR(ctrl->ctrl.admin_q);
3499                 goto out_cleanup_fabrics_q;
3500         }
3501
3502         /*
3503          * Would have been nice to init io queues tag set as well.
3504          * However, we require interaction from the controller
3505          * for max io queue count before we can do so.
3506          * Defer this to the connect path.
3507          */
3508
3509         ret = nvme_init_ctrl(&ctrl->ctrl, dev, &nvme_fc_ctrl_ops, 0);
3510         if (ret)
3511                 goto out_cleanup_admin_q;
3512
3513         /* at this point, teardown path changes to ref counting on nvme ctrl */
3514
3515         spin_lock_irqsave(&rport->lock, flags);
3516         list_add_tail(&ctrl->ctrl_list, &rport->ctrl_list);
3517         spin_unlock_irqrestore(&rport->lock, flags);
3518
3519         if (!nvme_change_ctrl_state(&ctrl->ctrl, NVME_CTRL_RESETTING) ||
3520             !nvme_change_ctrl_state(&ctrl->ctrl, NVME_CTRL_CONNECTING)) {
3521                 dev_err(ctrl->ctrl.device,
3522                         "NVME-FC{%d}: failed to init ctrl state\n", ctrl->cnum);
3523                 goto fail_ctrl;
3524         }
3525
3526         if (!queue_delayed_work(nvme_wq, &ctrl->connect_work, 0)) {
3527                 dev_err(ctrl->ctrl.device,
3528                         "NVME-FC{%d}: failed to schedule initial connect\n",
3529                         ctrl->cnum);
3530                 goto fail_ctrl;
3531         }
3532
3533         flush_delayed_work(&ctrl->connect_work);
3534
3535         dev_info(ctrl->ctrl.device,
3536                 "NVME-FC{%d}: new ctrl: NQN \"%s\"\n",
3537                 ctrl->cnum, ctrl->ctrl.opts->subsysnqn);
3538
3539         return &ctrl->ctrl;
3540
3541 fail_ctrl:
3542         nvme_change_ctrl_state(&ctrl->ctrl, NVME_CTRL_DELETING);
3543         cancel_work_sync(&ctrl->ctrl.reset_work);
3544         cancel_delayed_work_sync(&ctrl->connect_work);
3545
3546         ctrl->ctrl.opts = NULL;
3547
3548         /* initiate nvme ctrl ref counting teardown */
3549         nvme_uninit_ctrl(&ctrl->ctrl);
3550
3551         /* Remove core ctrl ref. */
3552         nvme_put_ctrl(&ctrl->ctrl);
3553
3554         /* as we're past the point where we transition to the ref
3555          * counting teardown path, if we return a bad pointer here,
3556          * the calling routine, thinking it's prior to the
3557          * transition, will do an rport put. Since the teardown
3558          * path also does a rport put, we do an extra get here to
3559          * so proper order/teardown happens.
3560          */
3561         nvme_fc_rport_get(rport);
3562
3563         return ERR_PTR(-EIO);
3564
3565 out_cleanup_admin_q:
3566         blk_cleanup_queue(ctrl->ctrl.admin_q);
3567 out_cleanup_fabrics_q:
3568         blk_cleanup_queue(ctrl->ctrl.fabrics_q);
3569 out_free_admin_tag_set:
3570         blk_mq_free_tag_set(&ctrl->admin_tag_set);
3571 out_free_queues:
3572         kfree(ctrl->queues);
3573 out_free_ida:
3574         put_device(ctrl->dev);
3575         ida_simple_remove(&nvme_fc_ctrl_cnt, ctrl->cnum);
3576 out_free_ctrl:
3577         kfree(ctrl);
3578 out_fail:
3579         /* exit via here doesn't follow ctlr ref points */
3580         return ERR_PTR(ret);
3581 }
3582
3583
3584 struct nvmet_fc_traddr {
3585         u64     nn;
3586         u64     pn;
3587 };
3588
3589 static int
3590 __nvme_fc_parse_u64(substring_t *sstr, u64 *val)
3591 {
3592         u64 token64;
3593
3594         if (match_u64(sstr, &token64))
3595                 return -EINVAL;
3596         *val = token64;
3597
3598         return 0;
3599 }
3600
3601 /*
3602  * This routine validates and extracts the WWN's from the TRADDR string.
3603  * As kernel parsers need the 0x to determine number base, universally
3604  * build string to parse with 0x prefix before parsing name strings.
3605  */
3606 static int
3607 nvme_fc_parse_traddr(struct nvmet_fc_traddr *traddr, char *buf, size_t blen)
3608 {
3609         char name[2 + NVME_FC_TRADDR_HEXNAMELEN + 1];
3610         substring_t wwn = { name, &name[sizeof(name)-1] };
3611         int nnoffset, pnoffset;
3612
3613         /* validate if string is one of the 2 allowed formats */
3614         if (strnlen(buf, blen) == NVME_FC_TRADDR_MAXLENGTH &&
3615                         !strncmp(buf, "nn-0x", NVME_FC_TRADDR_OXNNLEN) &&
3616                         !strncmp(&buf[NVME_FC_TRADDR_MAX_PN_OFFSET],
3617                                 "pn-0x", NVME_FC_TRADDR_OXNNLEN)) {
3618                 nnoffset = NVME_FC_TRADDR_OXNNLEN;
3619                 pnoffset = NVME_FC_TRADDR_MAX_PN_OFFSET +
3620                                                 NVME_FC_TRADDR_OXNNLEN;
3621         } else if ((strnlen(buf, blen) == NVME_FC_TRADDR_MINLENGTH &&
3622                         !strncmp(buf, "nn-", NVME_FC_TRADDR_NNLEN) &&
3623                         !strncmp(&buf[NVME_FC_TRADDR_MIN_PN_OFFSET],
3624                                 "pn-", NVME_FC_TRADDR_NNLEN))) {
3625                 nnoffset = NVME_FC_TRADDR_NNLEN;
3626                 pnoffset = NVME_FC_TRADDR_MIN_PN_OFFSET + NVME_FC_TRADDR_NNLEN;
3627         } else
3628                 goto out_einval;
3629
3630         name[0] = '0';
3631         name[1] = 'x';
3632         name[2 + NVME_FC_TRADDR_HEXNAMELEN] = 0;
3633
3634         memcpy(&name[2], &buf[nnoffset], NVME_FC_TRADDR_HEXNAMELEN);
3635         if (__nvme_fc_parse_u64(&wwn, &traddr->nn))
3636                 goto out_einval;
3637
3638         memcpy(&name[2], &buf[pnoffset], NVME_FC_TRADDR_HEXNAMELEN);
3639         if (__nvme_fc_parse_u64(&wwn, &traddr->pn))
3640                 goto out_einval;
3641
3642         return 0;
3643
3644 out_einval:
3645         pr_warn("%s: bad traddr string\n", __func__);
3646         return -EINVAL;
3647 }
3648
3649 static struct nvme_ctrl *
3650 nvme_fc_create_ctrl(struct device *dev, struct nvmf_ctrl_options *opts)
3651 {
3652         struct nvme_fc_lport *lport;
3653         struct nvme_fc_rport *rport;
3654         struct nvme_ctrl *ctrl;
3655         struct nvmet_fc_traddr laddr = { 0L, 0L };
3656         struct nvmet_fc_traddr raddr = { 0L, 0L };
3657         unsigned long flags;
3658         int ret;
3659
3660         ret = nvme_fc_parse_traddr(&raddr, opts->traddr, NVMF_TRADDR_SIZE);
3661         if (ret || !raddr.nn || !raddr.pn)
3662                 return ERR_PTR(-EINVAL);
3663
3664         ret = nvme_fc_parse_traddr(&laddr, opts->host_traddr, NVMF_TRADDR_SIZE);
3665         if (ret || !laddr.nn || !laddr.pn)
3666                 return ERR_PTR(-EINVAL);
3667
3668         /* find the host and remote ports to connect together */
3669         spin_lock_irqsave(&nvme_fc_lock, flags);
3670         list_for_each_entry(lport, &nvme_fc_lport_list, port_list) {
3671                 if (lport->localport.node_name != laddr.nn ||
3672                     lport->localport.port_name != laddr.pn ||
3673                     lport->localport.port_state != FC_OBJSTATE_ONLINE)
3674                         continue;
3675
3676                 list_for_each_entry(rport, &lport->endp_list, endp_list) {
3677                         if (rport->remoteport.node_name != raddr.nn ||
3678                             rport->remoteport.port_name != raddr.pn ||
3679                             rport->remoteport.port_state != FC_OBJSTATE_ONLINE)
3680                                 continue;
3681
3682                         /* if fail to get reference fall through. Will error */
3683                         if (!nvme_fc_rport_get(rport))
3684                                 break;
3685
3686                         spin_unlock_irqrestore(&nvme_fc_lock, flags);
3687
3688                         ctrl = nvme_fc_init_ctrl(dev, opts, lport, rport);
3689                         if (IS_ERR(ctrl))
3690                                 nvme_fc_rport_put(rport);
3691                         return ctrl;
3692                 }
3693         }
3694         spin_unlock_irqrestore(&nvme_fc_lock, flags);
3695
3696         pr_warn("%s: %s - %s combination not found\n",
3697                 __func__, opts->traddr, opts->host_traddr);
3698         return ERR_PTR(-ENOENT);
3699 }
3700
3701
3702 static struct nvmf_transport_ops nvme_fc_transport = {
3703         .name           = "fc",
3704         .module         = THIS_MODULE,
3705         .required_opts  = NVMF_OPT_TRADDR | NVMF_OPT_HOST_TRADDR,
3706         .allowed_opts   = NVMF_OPT_RECONNECT_DELAY | NVMF_OPT_CTRL_LOSS_TMO,
3707         .create_ctrl    = nvme_fc_create_ctrl,
3708 };
3709
3710 /* Arbitrary successive failures max. With lots of subsystems could be high */
3711 #define DISCOVERY_MAX_FAIL      20
3712
3713 static ssize_t nvme_fc_nvme_discovery_store(struct device *dev,
3714                 struct device_attribute *attr, const char *buf, size_t count)
3715 {
3716         unsigned long flags;
3717         LIST_HEAD(local_disc_list);
3718         struct nvme_fc_lport *lport;
3719         struct nvme_fc_rport *rport;
3720         int failcnt = 0;
3721
3722         spin_lock_irqsave(&nvme_fc_lock, flags);
3723 restart:
3724         list_for_each_entry(lport, &nvme_fc_lport_list, port_list) {
3725                 list_for_each_entry(rport, &lport->endp_list, endp_list) {
3726                         if (!nvme_fc_lport_get(lport))
3727                                 continue;
3728                         if (!nvme_fc_rport_get(rport)) {
3729                                 /*
3730                                  * This is a temporary condition. Upon restart
3731                                  * this rport will be gone from the list.
3732                                  *
3733                                  * Revert the lport put and retry.  Anything
3734                                  * added to the list already will be skipped (as
3735                                  * they are no longer list_empty).  Loops should
3736                                  * resume at rports that were not yet seen.
3737                                  */
3738                                 nvme_fc_lport_put(lport);
3739
3740                                 if (failcnt++ < DISCOVERY_MAX_FAIL)
3741                                         goto restart;
3742
3743                                 pr_err("nvme_discovery: too many reference "
3744                                        "failures\n");
3745                                 goto process_local_list;
3746                         }
3747                         if (list_empty(&rport->disc_list))
3748                                 list_add_tail(&rport->disc_list,
3749                                               &local_disc_list);
3750                 }
3751         }
3752
3753 process_local_list:
3754         while (!list_empty(&local_disc_list)) {
3755                 rport = list_first_entry(&local_disc_list,
3756                                          struct nvme_fc_rport, disc_list);
3757                 list_del_init(&rport->disc_list);
3758                 spin_unlock_irqrestore(&nvme_fc_lock, flags);
3759
3760                 lport = rport->lport;
3761                 /* signal discovery. Won't hurt if it repeats */
3762                 nvme_fc_signal_discovery_scan(lport, rport);
3763                 nvme_fc_rport_put(rport);
3764                 nvme_fc_lport_put(lport);
3765
3766                 spin_lock_irqsave(&nvme_fc_lock, flags);
3767         }
3768         spin_unlock_irqrestore(&nvme_fc_lock, flags);
3769
3770         return count;
3771 }
3772 static DEVICE_ATTR(nvme_discovery, 0200, NULL, nvme_fc_nvme_discovery_store);
3773
3774 static struct attribute *nvme_fc_attrs[] = {
3775         &dev_attr_nvme_discovery.attr,
3776         NULL
3777 };
3778
3779 static struct attribute_group nvme_fc_attr_group = {
3780         .attrs = nvme_fc_attrs,
3781 };
3782
3783 static const struct attribute_group *nvme_fc_attr_groups[] = {
3784         &nvme_fc_attr_group,
3785         NULL
3786 };
3787
3788 static struct class fc_class = {
3789         .name = "fc",
3790         .dev_groups = nvme_fc_attr_groups,
3791         .owner = THIS_MODULE,
3792 };
3793
3794 static int __init nvme_fc_init_module(void)
3795 {
3796         int ret;
3797
3798         nvme_fc_wq = alloc_workqueue("nvme_fc_wq", WQ_MEM_RECLAIM, 0);
3799         if (!nvme_fc_wq)
3800                 return -ENOMEM;
3801
3802         /*
3803          * NOTE:
3804          * It is expected that in the future the kernel will combine
3805          * the FC-isms that are currently under scsi and now being
3806          * added to by NVME into a new standalone FC class. The SCSI
3807          * and NVME protocols and their devices would be under this
3808          * new FC class.
3809          *
3810          * As we need something to post FC-specific udev events to,
3811          * specifically for nvme probe events, start by creating the
3812          * new device class.  When the new standalone FC class is
3813          * put in place, this code will move to a more generic
3814          * location for the class.
3815          */
3816         ret = class_register(&fc_class);
3817         if (ret) {
3818                 pr_err("couldn't register class fc\n");
3819                 goto out_destroy_wq;
3820         }
3821
3822         /*
3823          * Create a device for the FC-centric udev events
3824          */
3825         fc_udev_device = device_create(&fc_class, NULL, MKDEV(0, 0), NULL,
3826                                 "fc_udev_device");
3827         if (IS_ERR(fc_udev_device)) {
3828                 pr_err("couldn't create fc_udev device!\n");
3829                 ret = PTR_ERR(fc_udev_device);
3830                 goto out_destroy_class;
3831         }
3832
3833         ret = nvmf_register_transport(&nvme_fc_transport);
3834         if (ret)
3835                 goto out_destroy_device;
3836
3837         return 0;
3838
3839 out_destroy_device:
3840         device_destroy(&fc_class, MKDEV(0, 0));
3841 out_destroy_class:
3842         class_unregister(&fc_class);
3843 out_destroy_wq:
3844         destroy_workqueue(nvme_fc_wq);
3845
3846         return ret;
3847 }
3848
3849 static void
3850 nvme_fc_delete_controllers(struct nvme_fc_rport *rport)
3851 {
3852         struct nvme_fc_ctrl *ctrl;
3853
3854         spin_lock(&rport->lock);
3855         list_for_each_entry(ctrl, &rport->ctrl_list, ctrl_list) {
3856                 dev_warn(ctrl->ctrl.device,
3857                         "NVME-FC{%d}: transport unloading: deleting ctrl\n",
3858                         ctrl->cnum);
3859                 nvme_delete_ctrl(&ctrl->ctrl);
3860         }
3861         spin_unlock(&rport->lock);
3862 }
3863
3864 static void
3865 nvme_fc_cleanup_for_unload(void)
3866 {
3867         struct nvme_fc_lport *lport;
3868         struct nvme_fc_rport *rport;
3869
3870         list_for_each_entry(lport, &nvme_fc_lport_list, port_list) {
3871                 list_for_each_entry(rport, &lport->endp_list, endp_list) {
3872                         nvme_fc_delete_controllers(rport);
3873                 }
3874         }
3875 }
3876
3877 static void __exit nvme_fc_exit_module(void)
3878 {
3879         unsigned long flags;
3880         bool need_cleanup = false;
3881
3882         spin_lock_irqsave(&nvme_fc_lock, flags);
3883         nvme_fc_waiting_to_unload = true;
3884         if (!list_empty(&nvme_fc_lport_list)) {
3885                 need_cleanup = true;
3886                 nvme_fc_cleanup_for_unload();
3887         }
3888         spin_unlock_irqrestore(&nvme_fc_lock, flags);
3889         if (need_cleanup) {
3890                 pr_info("%s: waiting for ctlr deletes\n", __func__);
3891                 wait_for_completion(&nvme_fc_unload_proceed);
3892                 pr_info("%s: ctrl deletes complete\n", __func__);
3893         }
3894
3895         nvmf_unregister_transport(&nvme_fc_transport);
3896
3897         ida_destroy(&nvme_fc_local_port_cnt);
3898         ida_destroy(&nvme_fc_ctrl_cnt);
3899
3900         device_destroy(&fc_class, MKDEV(0, 0));
3901         class_unregister(&fc_class);
3902         destroy_workqueue(nvme_fc_wq);
3903 }
3904
3905 module_init(nvme_fc_init_module);
3906 module_exit(nvme_fc_exit_module);
3907
3908 MODULE_LICENSE("GPL v2");