| // SPDX-License-Identifier: GPL-2.0 |
| /* |
| * Copyright (c) 2016 Avago Technologies. All rights reserved. |
| */ |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| #include <linux/module.h> |
| #include <linux/parser.h> |
| #include <uapi/scsi/fc/fc_fs.h> |
| |
| #include "../host/nvme.h" |
| #include "../target/nvmet.h" |
| #include <linux/nvme-fc-driver.h> |
| #include <linux/nvme-fc.h> |
| |
| |
| enum { |
| NVMF_OPT_ERR = 0, |
| NVMF_OPT_WWNN = 1 << 0, |
| NVMF_OPT_WWPN = 1 << 1, |
| NVMF_OPT_ROLES = 1 << 2, |
| NVMF_OPT_FCADDR = 1 << 3, |
| NVMF_OPT_LPWWNN = 1 << 4, |
| NVMF_OPT_LPWWPN = 1 << 5, |
| }; |
| |
| struct fcloop_ctrl_options { |
| int mask; |
| u64 wwnn; |
| u64 wwpn; |
| u32 roles; |
| u32 fcaddr; |
| u64 lpwwnn; |
| u64 lpwwpn; |
| }; |
| |
| static const match_table_t opt_tokens = { |
| { NVMF_OPT_WWNN, "wwnn=%s" }, |
| { NVMF_OPT_WWPN, "wwpn=%s" }, |
| { NVMF_OPT_ROLES, "roles=%d" }, |
| { NVMF_OPT_FCADDR, "fcaddr=%x" }, |
| { NVMF_OPT_LPWWNN, "lpwwnn=%s" }, |
| { NVMF_OPT_LPWWPN, "lpwwpn=%s" }, |
| { NVMF_OPT_ERR, NULL } |
| }; |
| |
| static int fcloop_verify_addr(substring_t *s) |
| { |
| size_t blen = s->to - s->from + 1; |
| |
| if (strnlen(s->from, blen) != NVME_FC_TRADDR_HEXNAMELEN + 2 || |
| strncmp(s->from, "0x", 2)) |
| return -EINVAL; |
| |
| return 0; |
| } |
| |
| static int |
| fcloop_parse_options(struct fcloop_ctrl_options *opts, |
| const char *buf) |
| { |
| substring_t args[MAX_OPT_ARGS]; |
| char *options, *o, *p; |
| int token, ret = 0; |
| u64 token64; |
| |
| options = o = kstrdup(buf, GFP_KERNEL); |
| if (!options) |
| return -ENOMEM; |
| |
| while ((p = strsep(&o, ",\n")) != NULL) { |
| if (!*p) |
| continue; |
| |
| token = match_token(p, opt_tokens, args); |
| opts->mask |= token; |
| switch (token) { |
| case NVMF_OPT_WWNN: |
| if (fcloop_verify_addr(args) || |
| match_u64(args, &token64)) { |
| ret = -EINVAL; |
| goto out_free_options; |
| } |
| opts->wwnn = token64; |
| break; |
| case NVMF_OPT_WWPN: |
| if (fcloop_verify_addr(args) || |
| match_u64(args, &token64)) { |
| ret = -EINVAL; |
| goto out_free_options; |
| } |
| opts->wwpn = token64; |
| break; |
| case NVMF_OPT_ROLES: |
| if (match_int(args, &token)) { |
| ret = -EINVAL; |
| goto out_free_options; |
| } |
| opts->roles = token; |
| break; |
| case NVMF_OPT_FCADDR: |
| if (match_hex(args, &token)) { |
| ret = -EINVAL; |
| goto out_free_options; |
| } |
| opts->fcaddr = token; |
| break; |
| case NVMF_OPT_LPWWNN: |
| if (fcloop_verify_addr(args) || |
| match_u64(args, &token64)) { |
| ret = -EINVAL; |
| goto out_free_options; |
| } |
| opts->lpwwnn = token64; |
| break; |
| case NVMF_OPT_LPWWPN: |
| if (fcloop_verify_addr(args) || |
| match_u64(args, &token64)) { |
| ret = -EINVAL; |
| goto out_free_options; |
| } |
| opts->lpwwpn = token64; |
| break; |
| default: |
| pr_warn("unknown parameter or missing value '%s'\n", p); |
| ret = -EINVAL; |
| goto out_free_options; |
| } |
| } |
| |
| out_free_options: |
| kfree(options); |
| return ret; |
| } |
| |
| |
| static int |
| fcloop_parse_nm_options(struct device *dev, u64 *nname, u64 *pname, |
| const char *buf) |
| { |
| substring_t args[MAX_OPT_ARGS]; |
| char *options, *o, *p; |
| int token, ret = 0; |
| u64 token64; |
| |
| *nname = -1; |
| *pname = -1; |
| |
| options = o = kstrdup(buf, GFP_KERNEL); |
| if (!options) |
| return -ENOMEM; |
| |
| while ((p = strsep(&o, ",\n")) != NULL) { |
| if (!*p) |
| continue; |
| |
| token = match_token(p, opt_tokens, args); |
| switch (token) { |
| case NVMF_OPT_WWNN: |
| if (fcloop_verify_addr(args) || |
| match_u64(args, &token64)) { |
| ret = -EINVAL; |
| goto out_free_options; |
| } |
| *nname = token64; |
| break; |
| case NVMF_OPT_WWPN: |
| if (fcloop_verify_addr(args) || |
| match_u64(args, &token64)) { |
| ret = -EINVAL; |
| goto out_free_options; |
| } |
| *pname = token64; |
| break; |
| default: |
| pr_warn("unknown parameter or missing value '%s'\n", p); |
| ret = -EINVAL; |
| goto out_free_options; |
| } |
| } |
| |
| out_free_options: |
| kfree(options); |
| |
| if (!ret) { |
| if (*nname == -1) |
| return -EINVAL; |
| if (*pname == -1) |
| return -EINVAL; |
| } |
| |
| return ret; |
| } |
| |
| |
| #define LPORT_OPTS (NVMF_OPT_WWNN | NVMF_OPT_WWPN) |
| |
| #define RPORT_OPTS (NVMF_OPT_WWNN | NVMF_OPT_WWPN | \ |
| NVMF_OPT_LPWWNN | NVMF_OPT_LPWWPN) |
| |
| #define TGTPORT_OPTS (NVMF_OPT_WWNN | NVMF_OPT_WWPN) |
| |
| |
| static DEFINE_SPINLOCK(fcloop_lock); |
| static LIST_HEAD(fcloop_lports); |
| static LIST_HEAD(fcloop_nports); |
| |
| struct fcloop_lport { |
| struct nvme_fc_local_port *localport; |
| struct list_head lport_list; |
| struct completion unreg_done; |
| }; |
| |
| struct fcloop_lport_priv { |
| struct fcloop_lport *lport; |
| }; |
| |
| struct fcloop_rport { |
| struct nvme_fc_remote_port *remoteport; |
| struct nvmet_fc_target_port *targetport; |
| struct fcloop_nport *nport; |
| struct fcloop_lport *lport; |
| spinlock_t lock; |
| struct list_head ls_list; |
| struct work_struct ls_work; |
| }; |
| |
| struct fcloop_tport { |
| struct nvmet_fc_target_port *targetport; |
| struct nvme_fc_remote_port *remoteport; |
| struct fcloop_nport *nport; |
| struct fcloop_lport *lport; |
| spinlock_t lock; |
| struct list_head ls_list; |
| struct work_struct ls_work; |
| }; |
| |
| struct fcloop_nport { |
| struct fcloop_rport *rport; |
| struct fcloop_tport *tport; |
| struct fcloop_lport *lport; |
| struct list_head nport_list; |
| struct kref ref; |
| u64 node_name; |
| u64 port_name; |
| u32 port_role; |
| u32 port_id; |
| }; |
| |
| struct fcloop_lsreq { |
| struct nvmefc_ls_req *lsreq; |
| struct nvmefc_ls_rsp ls_rsp; |
| int lsdir; /* H2T or T2H */ |
| int status; |
| struct list_head ls_list; /* fcloop_rport->ls_list */ |
| }; |
| |
| struct fcloop_rscn { |
| struct fcloop_tport *tport; |
| struct work_struct work; |
| }; |
| |
| enum { |
| INI_IO_START = 0, |
| INI_IO_ACTIVE = 1, |
| INI_IO_ABORTED = 2, |
| INI_IO_COMPLETED = 3, |
| }; |
| |
| struct fcloop_fcpreq { |
| struct fcloop_tport *tport; |
| struct nvmefc_fcp_req *fcpreq; |
| spinlock_t reqlock; |
| u16 status; |
| u32 inistate; |
| bool active; |
| bool aborted; |
| struct kref ref; |
| struct work_struct fcp_rcv_work; |
| struct work_struct abort_rcv_work; |
| struct work_struct tio_done_work; |
| struct nvmefc_tgt_fcp_req tgt_fcp_req; |
| }; |
| |
| struct fcloop_ini_fcpreq { |
| struct nvmefc_fcp_req *fcpreq; |
| struct fcloop_fcpreq *tfcp_req; |
| spinlock_t inilock; |
| }; |
| |
| static inline struct fcloop_lsreq * |
| ls_rsp_to_lsreq(struct nvmefc_ls_rsp *lsrsp) |
| { |
| return container_of(lsrsp, struct fcloop_lsreq, ls_rsp); |
| } |
| |
| static inline struct fcloop_fcpreq * |
| tgt_fcp_req_to_fcpreq(struct nvmefc_tgt_fcp_req *tgt_fcpreq) |
| { |
| return container_of(tgt_fcpreq, struct fcloop_fcpreq, tgt_fcp_req); |
| } |
| |
| |
| static int |
| fcloop_create_queue(struct nvme_fc_local_port *localport, |
| unsigned int qidx, u16 qsize, |
| void **handle) |
| { |
| *handle = localport; |
| return 0; |
| } |
| |
| static void |
| fcloop_delete_queue(struct nvme_fc_local_port *localport, |
| unsigned int idx, void *handle) |
| { |
| } |
| |
| static void |
| fcloop_rport_lsrqst_work(struct work_struct *work) |
| { |
| struct fcloop_rport *rport = |
| container_of(work, struct fcloop_rport, ls_work); |
| struct fcloop_lsreq *tls_req; |
| |
| spin_lock(&rport->lock); |
| for (;;) { |
| tls_req = list_first_entry_or_null(&rport->ls_list, |
| struct fcloop_lsreq, ls_list); |
| if (!tls_req) |
| break; |
| |
| list_del(&tls_req->ls_list); |
| spin_unlock(&rport->lock); |
| |
| tls_req->lsreq->done(tls_req->lsreq, tls_req->status); |
| /* |
| * callee may free memory containing tls_req. |
| * do not reference lsreq after this. |
| */ |
| |
| spin_lock(&rport->lock); |
| } |
| spin_unlock(&rport->lock); |
| } |
| |
| static int |
| fcloop_h2t_ls_req(struct nvme_fc_local_port *localport, |
| struct nvme_fc_remote_port *remoteport, |
| struct nvmefc_ls_req *lsreq) |
| { |
| struct fcloop_lsreq *tls_req = lsreq->private; |
| struct fcloop_rport *rport = remoteport->private; |
| int ret = 0; |
| |
| tls_req->lsreq = lsreq; |
| INIT_LIST_HEAD(&tls_req->ls_list); |
| |
| if (!rport->targetport) { |
| tls_req->status = -ECONNREFUSED; |
| spin_lock(&rport->lock); |
| list_add_tail(&tls_req->ls_list, &rport->ls_list); |
| spin_unlock(&rport->lock); |
| queue_work(nvmet_wq, &rport->ls_work); |
| return ret; |
| } |
| |
| tls_req->status = 0; |
| ret = nvmet_fc_rcv_ls_req(rport->targetport, rport, |
| &tls_req->ls_rsp, |
| lsreq->rqstaddr, lsreq->rqstlen); |
| |
| return ret; |
| } |
| |
| static int |
| fcloop_h2t_xmt_ls_rsp(struct nvmet_fc_target_port *targetport, |
| struct nvmefc_ls_rsp *lsrsp) |
| { |
| struct fcloop_lsreq *tls_req = ls_rsp_to_lsreq(lsrsp); |
| struct nvmefc_ls_req *lsreq = tls_req->lsreq; |
| struct fcloop_tport *tport = targetport->private; |
| struct nvme_fc_remote_port *remoteport = tport->remoteport; |
| struct fcloop_rport *rport; |
| |
| memcpy(lsreq->rspaddr, lsrsp->rspbuf, |
| ((lsreq->rsplen < lsrsp->rsplen) ? |
| lsreq->rsplen : lsrsp->rsplen)); |
| |
| lsrsp->done(lsrsp); |
| |
| if (remoteport) { |
| rport = remoteport->private; |
| spin_lock(&rport->lock); |
| list_add_tail(&tls_req->ls_list, &rport->ls_list); |
| spin_unlock(&rport->lock); |
| queue_work(nvmet_wq, &rport->ls_work); |
| } |
| |
| return 0; |
| } |
| |
| static void |
| fcloop_tport_lsrqst_work(struct work_struct *work) |
| { |
| struct fcloop_tport *tport = |
| container_of(work, struct fcloop_tport, ls_work); |
| struct fcloop_lsreq *tls_req; |
| |
| spin_lock(&tport->lock); |
| for (;;) { |
| tls_req = list_first_entry_or_null(&tport->ls_list, |
| struct fcloop_lsreq, ls_list); |
| if (!tls_req) |
| break; |
| |
| list_del(&tls_req->ls_list); |
| spin_unlock(&tport->lock); |
| |
| tls_req->lsreq->done(tls_req->lsreq, tls_req->status); |
| /* |
| * callee may free memory containing tls_req. |
| * do not reference lsreq after this. |
| */ |
| |
| spin_lock(&tport->lock); |
| } |
| spin_unlock(&tport->lock); |
| } |
| |
| static int |
| fcloop_t2h_ls_req(struct nvmet_fc_target_port *targetport, void *hosthandle, |
| struct nvmefc_ls_req *lsreq) |
| { |
| struct fcloop_lsreq *tls_req = lsreq->private; |
| struct fcloop_tport *tport = targetport->private; |
| int ret = 0; |
| |
| /* |
| * hosthandle should be the dst.rport value. |
| * hosthandle ignored as fcloop currently is |
| * 1:1 tgtport vs remoteport |
| */ |
| tls_req->lsreq = lsreq; |
| INIT_LIST_HEAD(&tls_req->ls_list); |
| |
| if (!tport->remoteport) { |
| tls_req->status = -ECONNREFUSED; |
| spin_lock(&tport->lock); |
| list_add_tail(&tls_req->ls_list, &tport->ls_list); |
| spin_unlock(&tport->lock); |
| queue_work(nvmet_wq, &tport->ls_work); |
| return ret; |
| } |
| |
| tls_req->status = 0; |
| ret = nvme_fc_rcv_ls_req(tport->remoteport, &tls_req->ls_rsp, |
| lsreq->rqstaddr, lsreq->rqstlen); |
| |
| return ret; |
| } |
| |
| static int |
| fcloop_t2h_xmt_ls_rsp(struct nvme_fc_local_port *localport, |
| struct nvme_fc_remote_port *remoteport, |
| struct nvmefc_ls_rsp *lsrsp) |
| { |
| struct fcloop_lsreq *tls_req = ls_rsp_to_lsreq(lsrsp); |
| struct nvmefc_ls_req *lsreq = tls_req->lsreq; |
| struct fcloop_rport *rport = remoteport->private; |
| struct nvmet_fc_target_port *targetport = rport->targetport; |
| struct fcloop_tport *tport; |
| |
| memcpy(lsreq->rspaddr, lsrsp->rspbuf, |
| ((lsreq->rsplen < lsrsp->rsplen) ? |
| lsreq->rsplen : lsrsp->rsplen)); |
| lsrsp->done(lsrsp); |
| |
| if (targetport) { |
| tport = targetport->private; |
| spin_lock(&tport->lock); |
| list_add_tail(&tport->ls_list, &tls_req->ls_list); |
| spin_unlock(&tport->lock); |
| queue_work(nvmet_wq, &tport->ls_work); |
| } |
| |
| return 0; |
| } |
| |
| static void |
| fcloop_t2h_host_release(void *hosthandle) |
| { |
| /* host handle ignored for now */ |
| } |
| |
| /* |
| * Simulate reception of RSCN and converting it to a initiator transport |
| * call to rescan a remote port. |
| */ |
| static void |
| fcloop_tgt_rscn_work(struct work_struct *work) |
| { |
| struct fcloop_rscn *tgt_rscn = |
| container_of(work, struct fcloop_rscn, work); |
| struct fcloop_tport *tport = tgt_rscn->tport; |
| |
| if (tport->remoteport) |
| nvme_fc_rescan_remoteport(tport->remoteport); |
| kfree(tgt_rscn); |
| } |
| |
| static void |
| fcloop_tgt_discovery_evt(struct nvmet_fc_target_port *tgtport) |
| { |
| struct fcloop_rscn *tgt_rscn; |
| |
| tgt_rscn = kzalloc(sizeof(*tgt_rscn), GFP_KERNEL); |
| if (!tgt_rscn) |
| return; |
| |
| tgt_rscn->tport = tgtport->private; |
| INIT_WORK(&tgt_rscn->work, fcloop_tgt_rscn_work); |
| |
| queue_work(nvmet_wq, &tgt_rscn->work); |
| } |
| |
| static void |
| fcloop_tfcp_req_free(struct kref *ref) |
| { |
| struct fcloop_fcpreq *tfcp_req = |
| container_of(ref, struct fcloop_fcpreq, ref); |
| |
| kfree(tfcp_req); |
| } |
| |
| static void |
| fcloop_tfcp_req_put(struct fcloop_fcpreq *tfcp_req) |
| { |
| kref_put(&tfcp_req->ref, fcloop_tfcp_req_free); |
| } |
| |
| static int |
| fcloop_tfcp_req_get(struct fcloop_fcpreq *tfcp_req) |
| { |
| return kref_get_unless_zero(&tfcp_req->ref); |
| } |
| |
| static void |
| fcloop_call_host_done(struct nvmefc_fcp_req *fcpreq, |
| struct fcloop_fcpreq *tfcp_req, int status) |
| { |
| struct fcloop_ini_fcpreq *inireq = NULL; |
| |
| if (fcpreq) { |
| inireq = fcpreq->private; |
| spin_lock(&inireq->inilock); |
| inireq->tfcp_req = NULL; |
| spin_unlock(&inireq->inilock); |
| |
| fcpreq->status = status; |
| fcpreq->done(fcpreq); |
| } |
| |
| /* release original io reference on tgt struct */ |
| fcloop_tfcp_req_put(tfcp_req); |
| } |
| |
| static bool drop_fabric_opcode; |
| #define DROP_OPCODE_MASK 0x00FF |
| /* fabrics opcode will have a bit set above 1st byte */ |
| static int drop_opcode = -1; |
| static int drop_instance; |
| static int drop_amount; |
| static int drop_current_cnt; |
| |
| /* |
| * Routine to parse io and determine if the io is to be dropped. |
| * Returns: |
| * 0 if io is not obstructed |
| * 1 if io was dropped |
| */ |
| static int check_for_drop(struct fcloop_fcpreq *tfcp_req) |
| { |
| struct nvmefc_fcp_req *fcpreq = tfcp_req->fcpreq; |
| struct nvme_fc_cmd_iu *cmdiu = fcpreq->cmdaddr; |
| struct nvme_command *sqe = &cmdiu->sqe; |
| |
| if (drop_opcode == -1) |
| return 0; |
| |
| pr_info("%s: seq opcd x%02x fctype x%02x: drop F %s op x%02x " |
| "inst %d start %d amt %d\n", |
| __func__, sqe->common.opcode, sqe->fabrics.fctype, |
| drop_fabric_opcode ? "y" : "n", |
| drop_opcode, drop_current_cnt, drop_instance, drop_amount); |
| |
| if ((drop_fabric_opcode && |
| (sqe->common.opcode != nvme_fabrics_command || |
| sqe->fabrics.fctype != drop_opcode)) || |
| (!drop_fabric_opcode && sqe->common.opcode != drop_opcode)) |
| return 0; |
| |
| if (++drop_current_cnt >= drop_instance) { |
| if (drop_current_cnt >= drop_instance + drop_amount) |
| drop_opcode = -1; |
| return 1; |
| } |
| |
| return 0; |
| } |
| |
| static void |
| fcloop_fcp_recv_work(struct work_struct *work) |
| { |
| struct fcloop_fcpreq *tfcp_req = |
| container_of(work, struct fcloop_fcpreq, fcp_rcv_work); |
| struct nvmefc_fcp_req *fcpreq = tfcp_req->fcpreq; |
| unsigned long flags; |
| int ret = 0; |
| bool aborted = false; |
| |
| spin_lock_irqsave(&tfcp_req->reqlock, flags); |
| switch (tfcp_req->inistate) { |
| case INI_IO_START: |
| tfcp_req->inistate = INI_IO_ACTIVE; |
| break; |
| case INI_IO_ABORTED: |
| aborted = true; |
| break; |
| default: |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| WARN_ON(1); |
| return; |
| } |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| |
| if (unlikely(aborted)) |
| ret = -ECANCELED; |
| else { |
| if (likely(!check_for_drop(tfcp_req))) |
| ret = nvmet_fc_rcv_fcp_req(tfcp_req->tport->targetport, |
| &tfcp_req->tgt_fcp_req, |
| fcpreq->cmdaddr, fcpreq->cmdlen); |
| else |
| pr_info("%s: dropped command ********\n", __func__); |
| } |
| if (ret) |
| fcloop_call_host_done(fcpreq, tfcp_req, ret); |
| } |
| |
| static void |
| fcloop_fcp_abort_recv_work(struct work_struct *work) |
| { |
| struct fcloop_fcpreq *tfcp_req = |
| container_of(work, struct fcloop_fcpreq, abort_rcv_work); |
| struct nvmefc_fcp_req *fcpreq; |
| bool completed = false; |
| unsigned long flags; |
| |
| spin_lock_irqsave(&tfcp_req->reqlock, flags); |
| fcpreq = tfcp_req->fcpreq; |
| switch (tfcp_req->inistate) { |
| case INI_IO_ABORTED: |
| break; |
| case INI_IO_COMPLETED: |
| completed = true; |
| break; |
| default: |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| WARN_ON(1); |
| return; |
| } |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| |
| if (unlikely(completed)) { |
| /* remove reference taken in original abort downcall */ |
| fcloop_tfcp_req_put(tfcp_req); |
| return; |
| } |
| |
| if (tfcp_req->tport->targetport) |
| nvmet_fc_rcv_fcp_abort(tfcp_req->tport->targetport, |
| &tfcp_req->tgt_fcp_req); |
| |
| spin_lock_irqsave(&tfcp_req->reqlock, flags); |
| tfcp_req->fcpreq = NULL; |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| |
| fcloop_call_host_done(fcpreq, tfcp_req, -ECANCELED); |
| /* call_host_done releases reference for abort downcall */ |
| } |
| |
| /* |
| * FCP IO operation done by target completion. |
| * call back up initiator "done" flows. |
| */ |
| static void |
| fcloop_tgt_fcprqst_done_work(struct work_struct *work) |
| { |
| struct fcloop_fcpreq *tfcp_req = |
| container_of(work, struct fcloop_fcpreq, tio_done_work); |
| struct nvmefc_fcp_req *fcpreq; |
| unsigned long flags; |
| |
| spin_lock_irqsave(&tfcp_req->reqlock, flags); |
| fcpreq = tfcp_req->fcpreq; |
| tfcp_req->inistate = INI_IO_COMPLETED; |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| |
| fcloop_call_host_done(fcpreq, tfcp_req, tfcp_req->status); |
| } |
| |
| |
| static int |
| fcloop_fcp_req(struct nvme_fc_local_port *localport, |
| struct nvme_fc_remote_port *remoteport, |
| void *hw_queue_handle, |
| struct nvmefc_fcp_req *fcpreq) |
| { |
| struct fcloop_rport *rport = remoteport->private; |
| struct fcloop_ini_fcpreq *inireq = fcpreq->private; |
| struct fcloop_fcpreq *tfcp_req; |
| |
| if (!rport->targetport) |
| return -ECONNREFUSED; |
| |
| tfcp_req = kzalloc(sizeof(*tfcp_req), GFP_ATOMIC); |
| if (!tfcp_req) |
| return -ENOMEM; |
| |
| inireq->fcpreq = fcpreq; |
| inireq->tfcp_req = tfcp_req; |
| spin_lock_init(&inireq->inilock); |
| |
| tfcp_req->fcpreq = fcpreq; |
| tfcp_req->tport = rport->targetport->private; |
| tfcp_req->inistate = INI_IO_START; |
| spin_lock_init(&tfcp_req->reqlock); |
| INIT_WORK(&tfcp_req->fcp_rcv_work, fcloop_fcp_recv_work); |
| INIT_WORK(&tfcp_req->abort_rcv_work, fcloop_fcp_abort_recv_work); |
| INIT_WORK(&tfcp_req->tio_done_work, fcloop_tgt_fcprqst_done_work); |
| kref_init(&tfcp_req->ref); |
| |
| queue_work(nvmet_wq, &tfcp_req->fcp_rcv_work); |
| |
| return 0; |
| } |
| |
| static void |
| fcloop_fcp_copy_data(u8 op, struct scatterlist *data_sg, |
| struct scatterlist *io_sg, u32 offset, u32 length) |
| { |
| void *data_p, *io_p; |
| u32 data_len, io_len, tlen; |
| |
| io_p = sg_virt(io_sg); |
| io_len = io_sg->length; |
| |
| for ( ; offset; ) { |
| tlen = min_t(u32, offset, io_len); |
| offset -= tlen; |
| io_len -= tlen; |
| if (!io_len) { |
| io_sg = sg_next(io_sg); |
| io_p = sg_virt(io_sg); |
| io_len = io_sg->length; |
| } else |
| io_p += tlen; |
| } |
| |
| data_p = sg_virt(data_sg); |
| data_len = data_sg->length; |
| |
| for ( ; length; ) { |
| tlen = min_t(u32, io_len, data_len); |
| tlen = min_t(u32, tlen, length); |
| |
| if (op == NVMET_FCOP_WRITEDATA) |
| memcpy(data_p, io_p, tlen); |
| else |
| memcpy(io_p, data_p, tlen); |
| |
| length -= tlen; |
| |
| io_len -= tlen; |
| if ((!io_len) && (length)) { |
| io_sg = sg_next(io_sg); |
| io_p = sg_virt(io_sg); |
| io_len = io_sg->length; |
| } else |
| io_p += tlen; |
| |
| data_len -= tlen; |
| if ((!data_len) && (length)) { |
| data_sg = sg_next(data_sg); |
| data_p = sg_virt(data_sg); |
| data_len = data_sg->length; |
| } else |
| data_p += tlen; |
| } |
| } |
| |
| static int |
| fcloop_fcp_op(struct nvmet_fc_target_port *tgtport, |
| struct nvmefc_tgt_fcp_req *tgt_fcpreq) |
| { |
| struct fcloop_fcpreq *tfcp_req = tgt_fcp_req_to_fcpreq(tgt_fcpreq); |
| struct nvmefc_fcp_req *fcpreq; |
| u32 rsplen = 0, xfrlen = 0; |
| int fcp_err = 0, active, aborted; |
| u8 op = tgt_fcpreq->op; |
| unsigned long flags; |
| |
| spin_lock_irqsave(&tfcp_req->reqlock, flags); |
| fcpreq = tfcp_req->fcpreq; |
| active = tfcp_req->active; |
| aborted = tfcp_req->aborted; |
| tfcp_req->active = true; |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| |
| if (unlikely(active)) |
| /* illegal - call while i/o active */ |
| return -EALREADY; |
| |
| if (unlikely(aborted)) { |
| /* target transport has aborted i/o prior */ |
| spin_lock_irqsave(&tfcp_req->reqlock, flags); |
| tfcp_req->active = false; |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| tgt_fcpreq->transferred_length = 0; |
| tgt_fcpreq->fcp_error = -ECANCELED; |
| tgt_fcpreq->done(tgt_fcpreq); |
| return 0; |
| } |
| |
| /* |
| * if fcpreq is NULL, the I/O has been aborted (from |
| * initiator side). For the target side, act as if all is well |
| * but don't actually move data. |
| */ |
| |
| switch (op) { |
| case NVMET_FCOP_WRITEDATA: |
| xfrlen = tgt_fcpreq->transfer_length; |
| if (fcpreq) { |
| fcloop_fcp_copy_data(op, tgt_fcpreq->sg, |
| fcpreq->first_sgl, tgt_fcpreq->offset, |
| xfrlen); |
| fcpreq->transferred_length += xfrlen; |
| } |
| break; |
| |
| case NVMET_FCOP_READDATA: |
| case NVMET_FCOP_READDATA_RSP: |
| xfrlen = tgt_fcpreq->transfer_length; |
| if (fcpreq) { |
| fcloop_fcp_copy_data(op, tgt_fcpreq->sg, |
| fcpreq->first_sgl, tgt_fcpreq->offset, |
| xfrlen); |
| fcpreq->transferred_length += xfrlen; |
| } |
| if (op == NVMET_FCOP_READDATA) |
| break; |
| |
| /* Fall-Thru to RSP handling */ |
| fallthrough; |
| |
| case NVMET_FCOP_RSP: |
| if (fcpreq) { |
| rsplen = ((fcpreq->rsplen < tgt_fcpreq->rsplen) ? |
| fcpreq->rsplen : tgt_fcpreq->rsplen); |
| memcpy(fcpreq->rspaddr, tgt_fcpreq->rspaddr, rsplen); |
| if (rsplen < tgt_fcpreq->rsplen) |
| fcp_err = -E2BIG; |
| fcpreq->rcv_rsplen = rsplen; |
| fcpreq->status = 0; |
| } |
| tfcp_req->status = 0; |
| break; |
| |
| default: |
| fcp_err = -EINVAL; |
| break; |
| } |
| |
| spin_lock_irqsave(&tfcp_req->reqlock, flags); |
| tfcp_req->active = false; |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| |
| tgt_fcpreq->transferred_length = xfrlen; |
| tgt_fcpreq->fcp_error = fcp_err; |
| tgt_fcpreq->done(tgt_fcpreq); |
| |
| return 0; |
| } |
| |
| static void |
| fcloop_tgt_fcp_abort(struct nvmet_fc_target_port *tgtport, |
| struct nvmefc_tgt_fcp_req *tgt_fcpreq) |
| { |
| struct fcloop_fcpreq *tfcp_req = tgt_fcp_req_to_fcpreq(tgt_fcpreq); |
| unsigned long flags; |
| |
| /* |
| * mark aborted only in case there were 2 threads in transport |
| * (one doing io, other doing abort) and only kills ops posted |
| * after the abort request |
| */ |
| spin_lock_irqsave(&tfcp_req->reqlock, flags); |
| tfcp_req->aborted = true; |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| |
| tfcp_req->status = NVME_SC_INTERNAL; |
| |
| /* |
| * nothing more to do. If io wasn't active, the transport should |
| * immediately call the req_release. If it was active, the op |
| * will complete, and the lldd should call req_release. |
| */ |
| } |
| |
| static void |
| fcloop_fcp_req_release(struct nvmet_fc_target_port *tgtport, |
| struct nvmefc_tgt_fcp_req *tgt_fcpreq) |
| { |
| struct fcloop_fcpreq *tfcp_req = tgt_fcp_req_to_fcpreq(tgt_fcpreq); |
| |
| queue_work(nvmet_wq, &tfcp_req->tio_done_work); |
| } |
| |
| static void |
| fcloop_h2t_ls_abort(struct nvme_fc_local_port *localport, |
| struct nvme_fc_remote_port *remoteport, |
| struct nvmefc_ls_req *lsreq) |
| { |
| } |
| |
| static void |
| fcloop_t2h_ls_abort(struct nvmet_fc_target_port *targetport, |
| void *hosthandle, struct nvmefc_ls_req *lsreq) |
| { |
| } |
| |
| static void |
| fcloop_fcp_abort(struct nvme_fc_local_port *localport, |
| struct nvme_fc_remote_port *remoteport, |
| void *hw_queue_handle, |
| struct nvmefc_fcp_req *fcpreq) |
| { |
| struct fcloop_ini_fcpreq *inireq = fcpreq->private; |
| struct fcloop_fcpreq *tfcp_req; |
| bool abortio = true; |
| unsigned long flags; |
| |
| spin_lock(&inireq->inilock); |
| tfcp_req = inireq->tfcp_req; |
| if (tfcp_req) |
| fcloop_tfcp_req_get(tfcp_req); |
| spin_unlock(&inireq->inilock); |
| |
| if (!tfcp_req) |
| /* abort has already been called */ |
| return; |
| |
| /* break initiator/target relationship for io */ |
| spin_lock_irqsave(&tfcp_req->reqlock, flags); |
| switch (tfcp_req->inistate) { |
| case INI_IO_START: |
| case INI_IO_ACTIVE: |
| tfcp_req->inistate = INI_IO_ABORTED; |
| break; |
| case INI_IO_COMPLETED: |
| abortio = false; |
| break; |
| default: |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| WARN_ON(1); |
| return; |
| } |
| spin_unlock_irqrestore(&tfcp_req->reqlock, flags); |
| |
| if (abortio) |
| /* leave the reference while the work item is scheduled */ |
| WARN_ON(!queue_work(nvmet_wq, &tfcp_req->abort_rcv_work)); |
| else { |
| /* |
| * as the io has already had the done callback made, |
| * nothing more to do. So release the reference taken above |
| */ |
| fcloop_tfcp_req_put(tfcp_req); |
| } |
| } |
| |
| static void |
| fcloop_nport_free(struct kref *ref) |
| { |
| struct fcloop_nport *nport = |
| container_of(ref, struct fcloop_nport, ref); |
| unsigned long flags; |
| |
| spin_lock_irqsave(&fcloop_lock, flags); |
| list_del(&nport->nport_list); |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| |
| kfree(nport); |
| } |
| |
| static void |
| fcloop_nport_put(struct fcloop_nport *nport) |
| { |
| kref_put(&nport->ref, fcloop_nport_free); |
| } |
| |
| static int |
| fcloop_nport_get(struct fcloop_nport *nport) |
| { |
| return kref_get_unless_zero(&nport->ref); |
| } |
| |
| static void |
| fcloop_localport_delete(struct nvme_fc_local_port *localport) |
| { |
| struct fcloop_lport_priv *lport_priv = localport->private; |
| struct fcloop_lport *lport = lport_priv->lport; |
| |
| /* release any threads waiting for the unreg to complete */ |
| complete(&lport->unreg_done); |
| } |
| |
| static void |
| fcloop_remoteport_delete(struct nvme_fc_remote_port *remoteport) |
| { |
| struct fcloop_rport *rport = remoteport->private; |
| |
| flush_work(&rport->ls_work); |
| fcloop_nport_put(rport->nport); |
| } |
| |
| static void |
| fcloop_targetport_delete(struct nvmet_fc_target_port *targetport) |
| { |
| struct fcloop_tport *tport = targetport->private; |
| |
| flush_work(&tport->ls_work); |
| fcloop_nport_put(tport->nport); |
| } |
| |
| #define FCLOOP_HW_QUEUES 4 |
| #define FCLOOP_SGL_SEGS 256 |
| #define FCLOOP_DMABOUND_4G 0xFFFFFFFF |
| |
| static struct nvme_fc_port_template fctemplate = { |
| .localport_delete = fcloop_localport_delete, |
| .remoteport_delete = fcloop_remoteport_delete, |
| .create_queue = fcloop_create_queue, |
| .delete_queue = fcloop_delete_queue, |
| .ls_req = fcloop_h2t_ls_req, |
| .fcp_io = fcloop_fcp_req, |
| .ls_abort = fcloop_h2t_ls_abort, |
| .fcp_abort = fcloop_fcp_abort, |
| .xmt_ls_rsp = fcloop_t2h_xmt_ls_rsp, |
| .max_hw_queues = FCLOOP_HW_QUEUES, |
| .max_sgl_segments = FCLOOP_SGL_SEGS, |
| .max_dif_sgl_segments = FCLOOP_SGL_SEGS, |
| .dma_boundary = FCLOOP_DMABOUND_4G, |
| /* sizes of additional private data for data structures */ |
| .local_priv_sz = sizeof(struct fcloop_lport_priv), |
| .remote_priv_sz = sizeof(struct fcloop_rport), |
| .lsrqst_priv_sz = sizeof(struct fcloop_lsreq), |
| .fcprqst_priv_sz = sizeof(struct fcloop_ini_fcpreq), |
| }; |
| |
| static struct nvmet_fc_target_template tgttemplate = { |
| .targetport_delete = fcloop_targetport_delete, |
| .xmt_ls_rsp = fcloop_h2t_xmt_ls_rsp, |
| .fcp_op = fcloop_fcp_op, |
| .fcp_abort = fcloop_tgt_fcp_abort, |
| .fcp_req_release = fcloop_fcp_req_release, |
| .discovery_event = fcloop_tgt_discovery_evt, |
| .ls_req = fcloop_t2h_ls_req, |
| .ls_abort = fcloop_t2h_ls_abort, |
| .host_release = fcloop_t2h_host_release, |
| .max_hw_queues = FCLOOP_HW_QUEUES, |
| .max_sgl_segments = FCLOOP_SGL_SEGS, |
| .max_dif_sgl_segments = FCLOOP_SGL_SEGS, |
| .dma_boundary = FCLOOP_DMABOUND_4G, |
| /* optional features */ |
| .target_features = 0, |
| /* sizes of additional private data for data structures */ |
| .target_priv_sz = sizeof(struct fcloop_tport), |
| .lsrqst_priv_sz = sizeof(struct fcloop_lsreq), |
| }; |
| |
| static ssize_t |
| fcloop_create_local_port(struct device *dev, struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct nvme_fc_port_info pinfo; |
| struct fcloop_ctrl_options *opts; |
| struct nvme_fc_local_port *localport; |
| struct fcloop_lport *lport; |
| struct fcloop_lport_priv *lport_priv; |
| unsigned long flags; |
| int ret = -ENOMEM; |
| |
| lport = kzalloc(sizeof(*lport), GFP_KERNEL); |
| if (!lport) |
| return -ENOMEM; |
| |
| opts = kzalloc(sizeof(*opts), GFP_KERNEL); |
| if (!opts) |
| goto out_free_lport; |
| |
| ret = fcloop_parse_options(opts, buf); |
| if (ret) |
| goto out_free_opts; |
| |
| /* everything there ? */ |
| if ((opts->mask & LPORT_OPTS) != LPORT_OPTS) { |
| ret = -EINVAL; |
| goto out_free_opts; |
| } |
| |
| memset(&pinfo, 0, sizeof(pinfo)); |
| pinfo.node_name = opts->wwnn; |
| pinfo.port_name = opts->wwpn; |
| pinfo.port_role = opts->roles; |
| pinfo.port_id = opts->fcaddr; |
| |
| ret = nvme_fc_register_localport(&pinfo, &fctemplate, NULL, &localport); |
| if (!ret) { |
| /* success */ |
| lport_priv = localport->private; |
| lport_priv->lport = lport; |
| |
| lport->localport = localport; |
| INIT_LIST_HEAD(&lport->lport_list); |
| |
| spin_lock_irqsave(&fcloop_lock, flags); |
| list_add_tail(&lport->lport_list, &fcloop_lports); |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| } |
| |
| out_free_opts: |
| kfree(opts); |
| out_free_lport: |
| /* free only if we're going to fail */ |
| if (ret) |
| kfree(lport); |
| |
| return ret ? ret : count; |
| } |
| |
| |
| static void |
| __unlink_local_port(struct fcloop_lport *lport) |
| { |
| list_del(&lport->lport_list); |
| } |
| |
| static int |
| __wait_localport_unreg(struct fcloop_lport *lport) |
| { |
| int ret; |
| |
| init_completion(&lport->unreg_done); |
| |
| ret = nvme_fc_unregister_localport(lport->localport); |
| |
| if (!ret) |
| wait_for_completion(&lport->unreg_done); |
| |
| kfree(lport); |
| |
| return ret; |
| } |
| |
| |
| static ssize_t |
| fcloop_delete_local_port(struct device *dev, struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct fcloop_lport *tlport, *lport = NULL; |
| u64 nodename, portname; |
| unsigned long flags; |
| int ret; |
| |
| ret = fcloop_parse_nm_options(dev, &nodename, &portname, buf); |
| if (ret) |
| return ret; |
| |
| spin_lock_irqsave(&fcloop_lock, flags); |
| |
| list_for_each_entry(tlport, &fcloop_lports, lport_list) { |
| if (tlport->localport->node_name == nodename && |
| tlport->localport->port_name == portname) { |
| lport = tlport; |
| __unlink_local_port(lport); |
| break; |
| } |
| } |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| |
| if (!lport) |
| return -ENOENT; |
| |
| ret = __wait_localport_unreg(lport); |
| |
| return ret ? ret : count; |
| } |
| |
| static struct fcloop_nport * |
| fcloop_alloc_nport(const char *buf, size_t count, bool remoteport) |
| { |
| struct fcloop_nport *newnport, *nport = NULL; |
| struct fcloop_lport *tmplport, *lport = NULL; |
| struct fcloop_ctrl_options *opts; |
| unsigned long flags; |
| u32 opts_mask = (remoteport) ? RPORT_OPTS : TGTPORT_OPTS; |
| int ret; |
| |
| opts = kzalloc(sizeof(*opts), GFP_KERNEL); |
| if (!opts) |
| return NULL; |
| |
| ret = fcloop_parse_options(opts, buf); |
| if (ret) |
| goto out_free_opts; |
| |
| /* everything there ? */ |
| if ((opts->mask & opts_mask) != opts_mask) { |
| ret = -EINVAL; |
| goto out_free_opts; |
| } |
| |
| newnport = kzalloc(sizeof(*newnport), GFP_KERNEL); |
| if (!newnport) |
| goto out_free_opts; |
| |
| INIT_LIST_HEAD(&newnport->nport_list); |
| newnport->node_name = opts->wwnn; |
| newnport->port_name = opts->wwpn; |
| if (opts->mask & NVMF_OPT_ROLES) |
| newnport->port_role = opts->roles; |
| if (opts->mask & NVMF_OPT_FCADDR) |
| newnport->port_id = opts->fcaddr; |
| kref_init(&newnport->ref); |
| |
| spin_lock_irqsave(&fcloop_lock, flags); |
| |
| list_for_each_entry(tmplport, &fcloop_lports, lport_list) { |
| if (tmplport->localport->node_name == opts->wwnn && |
| tmplport->localport->port_name == opts->wwpn) |
| goto out_invalid_opts; |
| |
| if (tmplport->localport->node_name == opts->lpwwnn && |
| tmplport->localport->port_name == opts->lpwwpn) |
| lport = tmplport; |
| } |
| |
| if (remoteport) { |
| if (!lport) |
| goto out_invalid_opts; |
| newnport->lport = lport; |
| } |
| |
| list_for_each_entry(nport, &fcloop_nports, nport_list) { |
| if (nport->node_name == opts->wwnn && |
| nport->port_name == opts->wwpn) { |
| if ((remoteport && nport->rport) || |
| (!remoteport && nport->tport)) { |
| nport = NULL; |
| goto out_invalid_opts; |
| } |
| |
| fcloop_nport_get(nport); |
| |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| |
| if (remoteport) |
| nport->lport = lport; |
| if (opts->mask & NVMF_OPT_ROLES) |
| nport->port_role = opts->roles; |
| if (opts->mask & NVMF_OPT_FCADDR) |
| nport->port_id = opts->fcaddr; |
| goto out_free_newnport; |
| } |
| } |
| |
| list_add_tail(&newnport->nport_list, &fcloop_nports); |
| |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| |
| kfree(opts); |
| return newnport; |
| |
| out_invalid_opts: |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| out_free_newnport: |
| kfree(newnport); |
| out_free_opts: |
| kfree(opts); |
| return nport; |
| } |
| |
| static ssize_t |
| fcloop_create_remote_port(struct device *dev, struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct nvme_fc_remote_port *remoteport; |
| struct fcloop_nport *nport; |
| struct fcloop_rport *rport; |
| struct nvme_fc_port_info pinfo; |
| int ret; |
| |
| nport = fcloop_alloc_nport(buf, count, true); |
| if (!nport) |
| return -EIO; |
| |
| memset(&pinfo, 0, sizeof(pinfo)); |
| pinfo.node_name = nport->node_name; |
| pinfo.port_name = nport->port_name; |
| pinfo.port_role = nport->port_role; |
| pinfo.port_id = nport->port_id; |
| |
| ret = nvme_fc_register_remoteport(nport->lport->localport, |
| &pinfo, &remoteport); |
| if (ret || !remoteport) { |
| fcloop_nport_put(nport); |
| return ret; |
| } |
| |
| /* success */ |
| rport = remoteport->private; |
| rport->remoteport = remoteport; |
| rport->targetport = (nport->tport) ? nport->tport->targetport : NULL; |
| if (nport->tport) { |
| nport->tport->remoteport = remoteport; |
| nport->tport->lport = nport->lport; |
| } |
| rport->nport = nport; |
| rport->lport = nport->lport; |
| nport->rport = rport; |
| spin_lock_init(&rport->lock); |
| INIT_WORK(&rport->ls_work, fcloop_rport_lsrqst_work); |
| INIT_LIST_HEAD(&rport->ls_list); |
| |
| return count; |
| } |
| |
| |
| static struct fcloop_rport * |
| __unlink_remote_port(struct fcloop_nport *nport) |
| { |
| struct fcloop_rport *rport = nport->rport; |
| |
| if (rport && nport->tport) |
| nport->tport->remoteport = NULL; |
| nport->rport = NULL; |
| |
| return rport; |
| } |
| |
| static int |
| __remoteport_unreg(struct fcloop_nport *nport, struct fcloop_rport *rport) |
| { |
| if (!rport) |
| return -EALREADY; |
| |
| return nvme_fc_unregister_remoteport(rport->remoteport); |
| } |
| |
| static ssize_t |
| fcloop_delete_remote_port(struct device *dev, struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct fcloop_nport *nport = NULL, *tmpport; |
| static struct fcloop_rport *rport; |
| u64 nodename, portname; |
| unsigned long flags; |
| int ret; |
| |
| ret = fcloop_parse_nm_options(dev, &nodename, &portname, buf); |
| if (ret) |
| return ret; |
| |
| spin_lock_irqsave(&fcloop_lock, flags); |
| |
| list_for_each_entry(tmpport, &fcloop_nports, nport_list) { |
| if (tmpport->node_name == nodename && |
| tmpport->port_name == portname && tmpport->rport) { |
| nport = tmpport; |
| rport = __unlink_remote_port(nport); |
| break; |
| } |
| } |
| |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| |
| if (!nport) |
| return -ENOENT; |
| |
| ret = __remoteport_unreg(nport, rport); |
| |
| return ret ? ret : count; |
| } |
| |
| static ssize_t |
| fcloop_create_target_port(struct device *dev, struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct nvmet_fc_target_port *targetport; |
| struct fcloop_nport *nport; |
| struct fcloop_tport *tport; |
| struct nvmet_fc_port_info tinfo; |
| int ret; |
| |
| nport = fcloop_alloc_nport(buf, count, false); |
| if (!nport) |
| return -EIO; |
| |
| tinfo.node_name = nport->node_name; |
| tinfo.port_name = nport->port_name; |
| tinfo.port_id = nport->port_id; |
| |
| ret = nvmet_fc_register_targetport(&tinfo, &tgttemplate, NULL, |
| &targetport); |
| if (ret) { |
| fcloop_nport_put(nport); |
| return ret; |
| } |
| |
| /* success */ |
| tport = targetport->private; |
| tport->targetport = targetport; |
| tport->remoteport = (nport->rport) ? nport->rport->remoteport : NULL; |
| if (nport->rport) |
| nport->rport->targetport = targetport; |
| tport->nport = nport; |
| tport->lport = nport->lport; |
| nport->tport = tport; |
| spin_lock_init(&tport->lock); |
| INIT_WORK(&tport->ls_work, fcloop_tport_lsrqst_work); |
| INIT_LIST_HEAD(&tport->ls_list); |
| |
| return count; |
| } |
| |
| |
| static struct fcloop_tport * |
| __unlink_target_port(struct fcloop_nport *nport) |
| { |
| struct fcloop_tport *tport = nport->tport; |
| |
| if (tport && nport->rport) |
| nport->rport->targetport = NULL; |
| nport->tport = NULL; |
| |
| return tport; |
| } |
| |
| static int |
| __targetport_unreg(struct fcloop_nport *nport, struct fcloop_tport *tport) |
| { |
| if (!tport) |
| return -EALREADY; |
| |
| return nvmet_fc_unregister_targetport(tport->targetport); |
| } |
| |
| static ssize_t |
| fcloop_delete_target_port(struct device *dev, struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| struct fcloop_nport *nport = NULL, *tmpport; |
| struct fcloop_tport *tport = NULL; |
| u64 nodename, portname; |
| unsigned long flags; |
| int ret; |
| |
| ret = fcloop_parse_nm_options(dev, &nodename, &portname, buf); |
| if (ret) |
| return ret; |
| |
| spin_lock_irqsave(&fcloop_lock, flags); |
| |
| list_for_each_entry(tmpport, &fcloop_nports, nport_list) { |
| if (tmpport->node_name == nodename && |
| tmpport->port_name == portname && tmpport->tport) { |
| nport = tmpport; |
| tport = __unlink_target_port(nport); |
| break; |
| } |
| } |
| |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| |
| if (!nport) |
| return -ENOENT; |
| |
| ret = __targetport_unreg(nport, tport); |
| |
| return ret ? ret : count; |
| } |
| |
| static ssize_t |
| fcloop_set_cmd_drop(struct device *dev, struct device_attribute *attr, |
| const char *buf, size_t count) |
| { |
| unsigned int opcode; |
| int starting, amount; |
| |
| if (sscanf(buf, "%x:%d:%d", &opcode, &starting, &amount) != 3) |
| return -EBADRQC; |
| |
| drop_current_cnt = 0; |
| drop_fabric_opcode = (opcode & ~DROP_OPCODE_MASK) ? true : false; |
| drop_opcode = (opcode & DROP_OPCODE_MASK); |
| drop_instance = starting; |
| /* the check to drop routine uses instance + count to know when |
| * to end. Thus, if dropping 1 instance, count should be 0. |
| * so subtract 1 from the count. |
| */ |
| drop_amount = amount - 1; |
| |
| pr_info("%s: DROP: Starting at instance %d of%s opcode x%x drop +%d " |
| "instances\n", |
| __func__, drop_instance, drop_fabric_opcode ? " fabric" : "", |
| drop_opcode, drop_amount); |
| |
| return count; |
| } |
| |
| |
| static DEVICE_ATTR(add_local_port, 0200, NULL, fcloop_create_local_port); |
| static DEVICE_ATTR(del_local_port, 0200, NULL, fcloop_delete_local_port); |
| static DEVICE_ATTR(add_remote_port, 0200, NULL, fcloop_create_remote_port); |
| static DEVICE_ATTR(del_remote_port, 0200, NULL, fcloop_delete_remote_port); |
| static DEVICE_ATTR(add_target_port, 0200, NULL, fcloop_create_target_port); |
| static DEVICE_ATTR(del_target_port, 0200, NULL, fcloop_delete_target_port); |
| static DEVICE_ATTR(set_cmd_drop, 0200, NULL, fcloop_set_cmd_drop); |
| |
| static struct attribute *fcloop_dev_attrs[] = { |
| &dev_attr_add_local_port.attr, |
| &dev_attr_del_local_port.attr, |
| &dev_attr_add_remote_port.attr, |
| &dev_attr_del_remote_port.attr, |
| &dev_attr_add_target_port.attr, |
| &dev_attr_del_target_port.attr, |
| &dev_attr_set_cmd_drop.attr, |
| NULL |
| }; |
| |
| static const struct attribute_group fclopp_dev_attrs_group = { |
| .attrs = fcloop_dev_attrs, |
| }; |
| |
| static const struct attribute_group *fcloop_dev_attr_groups[] = { |
| &fclopp_dev_attrs_group, |
| NULL, |
| }; |
| |
| static struct class *fcloop_class; |
| static struct device *fcloop_device; |
| |
| |
| static int __init fcloop_init(void) |
| { |
| int ret; |
| |
| fcloop_class = class_create("fcloop"); |
| if (IS_ERR(fcloop_class)) { |
| pr_err("couldn't register class fcloop\n"); |
| ret = PTR_ERR(fcloop_class); |
| return ret; |
| } |
| |
| fcloop_device = device_create_with_groups( |
| fcloop_class, NULL, MKDEV(0, 0), NULL, |
| fcloop_dev_attr_groups, "ctl"); |
| if (IS_ERR(fcloop_device)) { |
| pr_err("couldn't create ctl device!\n"); |
| ret = PTR_ERR(fcloop_device); |
| goto out_destroy_class; |
| } |
| |
| get_device(fcloop_device); |
| |
| return 0; |
| |
| out_destroy_class: |
| class_destroy(fcloop_class); |
| return ret; |
| } |
| |
| static void __exit fcloop_exit(void) |
| { |
| struct fcloop_lport *lport = NULL; |
| struct fcloop_nport *nport = NULL; |
| struct fcloop_tport *tport; |
| struct fcloop_rport *rport; |
| unsigned long flags; |
| int ret; |
| |
| spin_lock_irqsave(&fcloop_lock, flags); |
| |
| for (;;) { |
| nport = list_first_entry_or_null(&fcloop_nports, |
| typeof(*nport), nport_list); |
| if (!nport) |
| break; |
| |
| tport = __unlink_target_port(nport); |
| rport = __unlink_remote_port(nport); |
| |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| |
| ret = __targetport_unreg(nport, tport); |
| if (ret) |
| pr_warn("%s: Failed deleting target port\n", __func__); |
| |
| ret = __remoteport_unreg(nport, rport); |
| if (ret) |
| pr_warn("%s: Failed deleting remote port\n", __func__); |
| |
| spin_lock_irqsave(&fcloop_lock, flags); |
| } |
| |
| for (;;) { |
| lport = list_first_entry_or_null(&fcloop_lports, |
| typeof(*lport), lport_list); |
| if (!lport) |
| break; |
| |
| __unlink_local_port(lport); |
| |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| |
| ret = __wait_localport_unreg(lport); |
| if (ret) |
| pr_warn("%s: Failed deleting local port\n", __func__); |
| |
| spin_lock_irqsave(&fcloop_lock, flags); |
| } |
| |
| spin_unlock_irqrestore(&fcloop_lock, flags); |
| |
| put_device(fcloop_device); |
| |
| device_destroy(fcloop_class, MKDEV(0, 0)); |
| class_destroy(fcloop_class); |
| } |
| |
| module_init(fcloop_init); |
| module_exit(fcloop_exit); |
| |
| MODULE_LICENSE("GPL v2"); |