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
10 #include "../host/nvme.h"
11 #include "../target/nvmet.h"
12 #include <linux/nvme-fc-driver.h>
13 #include <linux/nvme-fc.h>
14
15
16 enum {
17 NVMF_OPT_ERR = 0,
18 NVMF_OPT_WWNN = 1 << 0,
19 NVMF_OPT_WWPN = 1 << 1,
20 NVMF_OPT_ROLES = 1 << 2,
21 NVMF_OPT_FCADDR = 1 << 3,
22 NVMF_OPT_LPWWNN = 1 << 4,
23 NVMF_OPT_LPWWPN = 1 << 5,
24 };
25
26 struct fcloop_ctrl_options {
27 int mask;
28 u64 wwnn;
29 u64 wwpn;
30 u32 roles;
31 u32 fcaddr;
32 u64 lpwwnn;
33 u64 lpwwpn;
34 };
35
36 static const match_table_t opt_tokens = {
37 { NVMF_OPT_WWNN, "wwnn=%s" },
38 { NVMF_OPT_WWPN, "wwpn=%s" },
39 { NVMF_OPT_ROLES, "roles=%d" },
40 { NVMF_OPT_FCADDR, "fcaddr=%x" },
41 { NVMF_OPT_LPWWNN, "lpwwnn=%s" },
42 { NVMF_OPT_LPWWPN, "lpwwpn=%s" },
43 { NVMF_OPT_ERR, NULL }
44 };
45
fcloop_verify_addr(substring_t * s)46 static int fcloop_verify_addr(substring_t *s)
47 {
48 size_t blen = s->to - s->from + 1;
49
50 if (strnlen(s->from, blen) != NVME_FC_TRADDR_HEXNAMELEN + 2 ||
51 strncmp(s->from, "0x", 2))
52 return -EINVAL;
53
54 return 0;
55 }
56
57 static int
fcloop_parse_options(struct fcloop_ctrl_options * opts,const char * buf)58 fcloop_parse_options(struct fcloop_ctrl_options *opts,
59 const char *buf)
60 {
61 substring_t args[MAX_OPT_ARGS];
62 char *options, *o, *p;
63 int token, ret = 0;
64 u64 token64;
65
66 options = o = kstrdup(buf, GFP_KERNEL);
67 if (!options)
68 return -ENOMEM;
69
70 while ((p = strsep(&o, ",\n")) != NULL) {
71 if (!*p)
72 continue;
73
74 token = match_token(p, opt_tokens, args);
75 opts->mask |= token;
76 switch (token) {
77 case NVMF_OPT_WWNN:
78 if (fcloop_verify_addr(args) ||
79 match_u64(args, &token64)) {
80 ret = -EINVAL;
81 goto out_free_options;
82 }
83 opts->wwnn = token64;
84 break;
85 case NVMF_OPT_WWPN:
86 if (fcloop_verify_addr(args) ||
87 match_u64(args, &token64)) {
88 ret = -EINVAL;
89 goto out_free_options;
90 }
91 opts->wwpn = token64;
92 break;
93 case NVMF_OPT_ROLES:
94 if (match_int(args, &token)) {
95 ret = -EINVAL;
96 goto out_free_options;
97 }
98 opts->roles = token;
99 break;
100 case NVMF_OPT_FCADDR:
101 if (match_hex(args, &token)) {
102 ret = -EINVAL;
103 goto out_free_options;
104 }
105 opts->fcaddr = token;
106 break;
107 case NVMF_OPT_LPWWNN:
108 if (fcloop_verify_addr(args) ||
109 match_u64(args, &token64)) {
110 ret = -EINVAL;
111 goto out_free_options;
112 }
113 opts->lpwwnn = token64;
114 break;
115 case NVMF_OPT_LPWWPN:
116 if (fcloop_verify_addr(args) ||
117 match_u64(args, &token64)) {
118 ret = -EINVAL;
119 goto out_free_options;
120 }
121 opts->lpwwpn = token64;
122 break;
123 default:
124 pr_warn("unknown parameter or missing value '%s'\n", p);
125 ret = -EINVAL;
126 goto out_free_options;
127 }
128 }
129
130 out_free_options:
131 kfree(options);
132 return ret;
133 }
134
135
136 static int
fcloop_parse_nm_options(struct device * dev,u64 * nname,u64 * pname,const char * buf)137 fcloop_parse_nm_options(struct device *dev, u64 *nname, u64 *pname,
138 const char *buf)
139 {
140 substring_t args[MAX_OPT_ARGS];
141 char *options, *o, *p;
142 int token, ret = 0;
143 u64 token64;
144
145 *nname = -1;
146 *pname = -1;
147
148 options = o = kstrdup(buf, GFP_KERNEL);
149 if (!options)
150 return -ENOMEM;
151
152 while ((p = strsep(&o, ",\n")) != NULL) {
153 if (!*p)
154 continue;
155
156 token = match_token(p, opt_tokens, args);
157 switch (token) {
158 case NVMF_OPT_WWNN:
159 if (fcloop_verify_addr(args) ||
160 match_u64(args, &token64)) {
161 ret = -EINVAL;
162 goto out_free_options;
163 }
164 *nname = token64;
165 break;
166 case NVMF_OPT_WWPN:
167 if (fcloop_verify_addr(args) ||
168 match_u64(args, &token64)) {
169 ret = -EINVAL;
170 goto out_free_options;
171 }
172 *pname = token64;
173 break;
174 default:
175 pr_warn("unknown parameter or missing value '%s'\n", p);
176 ret = -EINVAL;
177 goto out_free_options;
178 }
179 }
180
181 out_free_options:
182 kfree(options);
183
184 if (!ret) {
185 if (*nname == -1)
186 return -EINVAL;
187 if (*pname == -1)
188 return -EINVAL;
189 }
190
191 return ret;
192 }
193
194
195 #define LPORT_OPTS (NVMF_OPT_WWNN | NVMF_OPT_WWPN)
196
197 #define RPORT_OPTS (NVMF_OPT_WWNN | NVMF_OPT_WWPN | \
198 NVMF_OPT_LPWWNN | NVMF_OPT_LPWWPN)
199
200 #define TGTPORT_OPTS (NVMF_OPT_WWNN | NVMF_OPT_WWPN)
201
202
203 static DEFINE_SPINLOCK(fcloop_lock);
204 static LIST_HEAD(fcloop_lports);
205 static LIST_HEAD(fcloop_nports);
206
207 struct fcloop_lport {
208 struct nvme_fc_local_port *localport;
209 struct list_head lport_list;
210 struct completion unreg_done;
211 };
212
213 struct fcloop_lport_priv {
214 struct fcloop_lport *lport;
215 };
216
217 struct fcloop_rport {
218 struct nvme_fc_remote_port *remoteport;
219 struct nvmet_fc_target_port *targetport;
220 struct fcloop_nport *nport;
221 struct fcloop_lport *lport;
222 spinlock_t lock;
223 struct list_head ls_list;
224 struct work_struct ls_work;
225 };
226
227 struct fcloop_tport {
228 struct nvmet_fc_target_port *targetport;
229 struct nvme_fc_remote_port *remoteport;
230 struct fcloop_nport *nport;
231 struct fcloop_lport *lport;
232 spinlock_t lock;
233 struct list_head ls_list;
234 struct work_struct ls_work;
235 };
236
237 struct fcloop_nport {
238 struct fcloop_rport *rport;
239 struct fcloop_tport *tport;
240 struct fcloop_lport *lport;
241 struct list_head nport_list;
242 struct kref ref;
243 u64 node_name;
244 u64 port_name;
245 u32 port_role;
246 u32 port_id;
247 };
248
249 struct fcloop_lsreq {
250 struct nvmefc_ls_req *lsreq;
251 struct nvmefc_ls_rsp ls_rsp;
252 int lsdir; /* H2T or T2H */
253 int status;
254 struct list_head ls_list; /* fcloop_rport->ls_list */
255 };
256
257 struct fcloop_rscn {
258 struct fcloop_tport *tport;
259 struct work_struct work;
260 };
261
262 enum {
263 INI_IO_START = 0,
264 INI_IO_ACTIVE = 1,
265 INI_IO_ABORTED = 2,
266 INI_IO_COMPLETED = 3,
267 };
268
269 struct fcloop_fcpreq {
270 struct fcloop_tport *tport;
271 struct nvmefc_fcp_req *fcpreq;
272 spinlock_t reqlock;
273 u16 status;
274 u32 inistate;
275 bool active;
276 bool aborted;
277 struct kref ref;
278 struct work_struct fcp_rcv_work;
279 struct work_struct abort_rcv_work;
280 struct work_struct tio_done_work;
281 struct nvmefc_tgt_fcp_req tgt_fcp_req;
282 };
283
284 struct fcloop_ini_fcpreq {
285 struct nvmefc_fcp_req *fcpreq;
286 struct fcloop_fcpreq *tfcp_req;
287 spinlock_t inilock;
288 };
289
290 static inline struct fcloop_lsreq *
ls_rsp_to_lsreq(struct nvmefc_ls_rsp * lsrsp)291 ls_rsp_to_lsreq(struct nvmefc_ls_rsp *lsrsp)
292 {
293 return container_of(lsrsp, struct fcloop_lsreq, ls_rsp);
294 }
295
296 static inline struct fcloop_fcpreq *
tgt_fcp_req_to_fcpreq(struct nvmefc_tgt_fcp_req * tgt_fcpreq)297 tgt_fcp_req_to_fcpreq(struct nvmefc_tgt_fcp_req *tgt_fcpreq)
298 {
299 return container_of(tgt_fcpreq, struct fcloop_fcpreq, tgt_fcp_req);
300 }
301
302
303 static int
fcloop_create_queue(struct nvme_fc_local_port * localport,unsigned int qidx,u16 qsize,void ** handle)304 fcloop_create_queue(struct nvme_fc_local_port *localport,
305 unsigned int qidx, u16 qsize,
306 void **handle)
307 {
308 *handle = localport;
309 return 0;
310 }
311
312 static void
fcloop_delete_queue(struct nvme_fc_local_port * localport,unsigned int idx,void * handle)313 fcloop_delete_queue(struct nvme_fc_local_port *localport,
314 unsigned int idx, void *handle)
315 {
316 }
317
318 static void
fcloop_rport_lsrqst_work(struct work_struct * work)319 fcloop_rport_lsrqst_work(struct work_struct *work)
320 {
321 struct fcloop_rport *rport =
322 container_of(work, struct fcloop_rport, ls_work);
323 struct fcloop_lsreq *tls_req;
324
325 spin_lock(&rport->lock);
326 for (;;) {
327 tls_req = list_first_entry_or_null(&rport->ls_list,
328 struct fcloop_lsreq, ls_list);
329 if (!tls_req)
330 break;
331
332 list_del(&tls_req->ls_list);
333 spin_unlock(&rport->lock);
334
335 tls_req->lsreq->done(tls_req->lsreq, tls_req->status);
336 /*
337 * callee may free memory containing tls_req.
338 * do not reference lsreq after this.
339 */
340
341 spin_lock(&rport->lock);
342 }
343 spin_unlock(&rport->lock);
344 }
345
346 static int
fcloop_h2t_ls_req(struct nvme_fc_local_port * localport,struct nvme_fc_remote_port * remoteport,struct nvmefc_ls_req * lsreq)347 fcloop_h2t_ls_req(struct nvme_fc_local_port *localport,
348 struct nvme_fc_remote_port *remoteport,
349 struct nvmefc_ls_req *lsreq)
350 {
351 struct fcloop_lsreq *tls_req = lsreq->private;
352 struct fcloop_rport *rport = remoteport->private;
353 int ret = 0;
354
355 tls_req->lsreq = lsreq;
356 INIT_LIST_HEAD(&tls_req->ls_list);
357
358 if (!rport->targetport) {
359 tls_req->status = -ECONNREFUSED;
360 spin_lock(&rport->lock);
361 list_add_tail(&tls_req->ls_list, &rport->ls_list);
362 spin_unlock(&rport->lock);
363 queue_work(nvmet_wq, &rport->ls_work);
364 return ret;
365 }
366
367 tls_req->status = 0;
368 ret = nvmet_fc_rcv_ls_req(rport->targetport, rport,
369 &tls_req->ls_rsp,
370 lsreq->rqstaddr, lsreq->rqstlen);
371
372 return ret;
373 }
374
375 static int
fcloop_h2t_xmt_ls_rsp(struct nvmet_fc_target_port * targetport,struct nvmefc_ls_rsp * lsrsp)376 fcloop_h2t_xmt_ls_rsp(struct nvmet_fc_target_port *targetport,
377 struct nvmefc_ls_rsp *lsrsp)
378 {
379 struct fcloop_lsreq *tls_req = ls_rsp_to_lsreq(lsrsp);
380 struct nvmefc_ls_req *lsreq = tls_req->lsreq;
381 struct fcloop_tport *tport = targetport->private;
382 struct nvme_fc_remote_port *remoteport = tport->remoteport;
383 struct fcloop_rport *rport;
384
385 memcpy(lsreq->rspaddr, lsrsp->rspbuf,
386 ((lsreq->rsplen < lsrsp->rsplen) ?
387 lsreq->rsplen : lsrsp->rsplen));
388
389 lsrsp->done(lsrsp);
390
391 if (remoteport) {
392 rport = remoteport->private;
393 spin_lock(&rport->lock);
394 list_add_tail(&tls_req->ls_list, &rport->ls_list);
395 spin_unlock(&rport->lock);
396 queue_work(nvmet_wq, &rport->ls_work);
397 }
398
399 return 0;
400 }
401
402 static void
fcloop_tport_lsrqst_work(struct work_struct * work)403 fcloop_tport_lsrqst_work(struct work_struct *work)
404 {
405 struct fcloop_tport *tport =
406 container_of(work, struct fcloop_tport, ls_work);
407 struct fcloop_lsreq *tls_req;
408
409 spin_lock(&tport->lock);
410 for (;;) {
411 tls_req = list_first_entry_or_null(&tport->ls_list,
412 struct fcloop_lsreq, ls_list);
413 if (!tls_req)
414 break;
415
416 list_del(&tls_req->ls_list);
417 spin_unlock(&tport->lock);
418
419 tls_req->lsreq->done(tls_req->lsreq, tls_req->status);
420 /*
421 * callee may free memory containing tls_req.
422 * do not reference lsreq after this.
423 */
424
425 spin_lock(&tport->lock);
426 }
427 spin_unlock(&tport->lock);
428 }
429
430 static int
fcloop_t2h_ls_req(struct nvmet_fc_target_port * targetport,void * hosthandle,struct nvmefc_ls_req * lsreq)431 fcloop_t2h_ls_req(struct nvmet_fc_target_port *targetport, void *hosthandle,
432 struct nvmefc_ls_req *lsreq)
433 {
434 struct fcloop_lsreq *tls_req = lsreq->private;
435 struct fcloop_tport *tport = targetport->private;
436 int ret = 0;
437
438 /*
439 * hosthandle should be the dst.rport value.
440 * hosthandle ignored as fcloop currently is
441 * 1:1 tgtport vs remoteport
442 */
443 tls_req->lsreq = lsreq;
444 INIT_LIST_HEAD(&tls_req->ls_list);
445
446 if (!tport->remoteport) {
447 tls_req->status = -ECONNREFUSED;
448 spin_lock(&tport->lock);
449 list_add_tail(&tls_req->ls_list, &tport->ls_list);
450 spin_unlock(&tport->lock);
451 queue_work(nvmet_wq, &tport->ls_work);
452 return ret;
453 }
454
455 tls_req->status = 0;
456 ret = nvme_fc_rcv_ls_req(tport->remoteport, &tls_req->ls_rsp,
457 lsreq->rqstaddr, lsreq->rqstlen);
458
459 return ret;
460 }
461
462 static int
fcloop_t2h_xmt_ls_rsp(struct nvme_fc_local_port * localport,struct nvme_fc_remote_port * remoteport,struct nvmefc_ls_rsp * lsrsp)463 fcloop_t2h_xmt_ls_rsp(struct nvme_fc_local_port *localport,
464 struct nvme_fc_remote_port *remoteport,
465 struct nvmefc_ls_rsp *lsrsp)
466 {
467 struct fcloop_lsreq *tls_req = ls_rsp_to_lsreq(lsrsp);
468 struct nvmefc_ls_req *lsreq = tls_req->lsreq;
469 struct fcloop_rport *rport = remoteport->private;
470 struct nvmet_fc_target_port *targetport = rport->targetport;
471 struct fcloop_tport *tport;
472
473 memcpy(lsreq->rspaddr, lsrsp->rspbuf,
474 ((lsreq->rsplen < lsrsp->rsplen) ?
475 lsreq->rsplen : lsrsp->rsplen));
476 lsrsp->done(lsrsp);
477
478 if (targetport) {
479 tport = targetport->private;
480 spin_lock(&tport->lock);
481 list_add_tail(&tport->ls_list, &tls_req->ls_list);
482 spin_unlock(&tport->lock);
483 queue_work(nvmet_wq, &tport->ls_work);
484 }
485
486 return 0;
487 }
488
489 static void
fcloop_t2h_host_release(void * hosthandle)490 fcloop_t2h_host_release(void *hosthandle)
491 {
492 /* host handle ignored for now */
493 }
494
495 static int
fcloop_t2h_host_traddr(void * hosthandle,u64 * wwnn,u64 * wwpn)496 fcloop_t2h_host_traddr(void *hosthandle, u64 *wwnn, u64 *wwpn)
497 {
498 struct fcloop_rport *rport = hosthandle;
499
500 *wwnn = rport->lport->localport->node_name;
501 *wwpn = rport->lport->localport->port_name;
502 return 0;
503 }
504
505 /*
506 * Simulate reception of RSCN and converting it to a initiator transport
507 * call to rescan a remote port.
508 */
509 static void
fcloop_tgt_rscn_work(struct work_struct * work)510 fcloop_tgt_rscn_work(struct work_struct *work)
511 {
512 struct fcloop_rscn *tgt_rscn =
513 container_of(work, struct fcloop_rscn, work);
514 struct fcloop_tport *tport = tgt_rscn->tport;
515
516 if (tport->remoteport)
517 nvme_fc_rescan_remoteport(tport->remoteport);
518 kfree(tgt_rscn);
519 }
520
521 static void
fcloop_tgt_discovery_evt(struct nvmet_fc_target_port * tgtport)522 fcloop_tgt_discovery_evt(struct nvmet_fc_target_port *tgtport)
523 {
524 struct fcloop_rscn *tgt_rscn;
525
526 tgt_rscn = kzalloc(sizeof(*tgt_rscn), GFP_KERNEL);
527 if (!tgt_rscn)
528 return;
529
530 tgt_rscn->tport = tgtport->private;
531 INIT_WORK(&tgt_rscn->work, fcloop_tgt_rscn_work);
532
533 queue_work(nvmet_wq, &tgt_rscn->work);
534 }
535
536 static void
fcloop_tfcp_req_free(struct kref * ref)537 fcloop_tfcp_req_free(struct kref *ref)
538 {
539 struct fcloop_fcpreq *tfcp_req =
540 container_of(ref, struct fcloop_fcpreq, ref);
541
542 kfree(tfcp_req);
543 }
544
545 static void
fcloop_tfcp_req_put(struct fcloop_fcpreq * tfcp_req)546 fcloop_tfcp_req_put(struct fcloop_fcpreq *tfcp_req)
547 {
548 kref_put(&tfcp_req->ref, fcloop_tfcp_req_free);
549 }
550
551 static int
fcloop_tfcp_req_get(struct fcloop_fcpreq * tfcp_req)552 fcloop_tfcp_req_get(struct fcloop_fcpreq *tfcp_req)
553 {
554 return kref_get_unless_zero(&tfcp_req->ref);
555 }
556
557 static void
fcloop_call_host_done(struct nvmefc_fcp_req * fcpreq,struct fcloop_fcpreq * tfcp_req,int status)558 fcloop_call_host_done(struct nvmefc_fcp_req *fcpreq,
559 struct fcloop_fcpreq *tfcp_req, int status)
560 {
561 struct fcloop_ini_fcpreq *inireq = NULL;
562
563 if (fcpreq) {
564 inireq = fcpreq->private;
565 spin_lock(&inireq->inilock);
566 inireq->tfcp_req = NULL;
567 spin_unlock(&inireq->inilock);
568
569 fcpreq->status = status;
570 fcpreq->done(fcpreq);
571 }
572
573 /* release original io reference on tgt struct */
574 fcloop_tfcp_req_put(tfcp_req);
575 }
576
577 static bool drop_fabric_opcode;
578 #define DROP_OPCODE_MASK 0x00FF
579 /* fabrics opcode will have a bit set above 1st byte */
580 static int drop_opcode = -1;
581 static int drop_instance;
582 static int drop_amount;
583 static int drop_current_cnt;
584
585 /*
586 * Routine to parse io and determine if the io is to be dropped.
587 * Returns:
588 * 0 if io is not obstructed
589 * 1 if io was dropped
590 */
check_for_drop(struct fcloop_fcpreq * tfcp_req)591 static int check_for_drop(struct fcloop_fcpreq *tfcp_req)
592 {
593 struct nvmefc_fcp_req *fcpreq = tfcp_req->fcpreq;
594 struct nvme_fc_cmd_iu *cmdiu = fcpreq->cmdaddr;
595 struct nvme_command *sqe = &cmdiu->sqe;
596
597 if (drop_opcode == -1)
598 return 0;
599
600 pr_info("%s: seq opcd x%02x fctype x%02x: drop F %s op x%02x "
601 "inst %d start %d amt %d\n",
602 __func__, sqe->common.opcode, sqe->fabrics.fctype,
603 drop_fabric_opcode ? "y" : "n",
604 drop_opcode, drop_current_cnt, drop_instance, drop_amount);
605
606 if ((drop_fabric_opcode &&
607 (sqe->common.opcode != nvme_fabrics_command ||
608 sqe->fabrics.fctype != drop_opcode)) ||
609 (!drop_fabric_opcode && sqe->common.opcode != drop_opcode))
610 return 0;
611
612 if (++drop_current_cnt >= drop_instance) {
613 if (drop_current_cnt >= drop_instance + drop_amount)
614 drop_opcode = -1;
615 return 1;
616 }
617
618 return 0;
619 }
620
621 static void
fcloop_fcp_recv_work(struct work_struct * work)622 fcloop_fcp_recv_work(struct work_struct *work)
623 {
624 struct fcloop_fcpreq *tfcp_req =
625 container_of(work, struct fcloop_fcpreq, fcp_rcv_work);
626 struct nvmefc_fcp_req *fcpreq = tfcp_req->fcpreq;
627 unsigned long flags;
628 int ret = 0;
629 bool aborted = false;
630
631 spin_lock_irqsave(&tfcp_req->reqlock, flags);
632 switch (tfcp_req->inistate) {
633 case INI_IO_START:
634 tfcp_req->inistate = INI_IO_ACTIVE;
635 break;
636 case INI_IO_ABORTED:
637 aborted = true;
638 break;
639 default:
640 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
641 WARN_ON(1);
642 return;
643 }
644 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
645
646 if (unlikely(aborted))
647 ret = -ECANCELED;
648 else {
649 if (likely(!check_for_drop(tfcp_req)))
650 ret = nvmet_fc_rcv_fcp_req(tfcp_req->tport->targetport,
651 &tfcp_req->tgt_fcp_req,
652 fcpreq->cmdaddr, fcpreq->cmdlen);
653 else
654 pr_info("%s: dropped command ********\n", __func__);
655 }
656 if (ret)
657 fcloop_call_host_done(fcpreq, tfcp_req, ret);
658 }
659
660 static void
fcloop_fcp_abort_recv_work(struct work_struct * work)661 fcloop_fcp_abort_recv_work(struct work_struct *work)
662 {
663 struct fcloop_fcpreq *tfcp_req =
664 container_of(work, struct fcloop_fcpreq, abort_rcv_work);
665 struct nvmefc_fcp_req *fcpreq;
666 bool completed = false;
667 unsigned long flags;
668
669 spin_lock_irqsave(&tfcp_req->reqlock, flags);
670 fcpreq = tfcp_req->fcpreq;
671 switch (tfcp_req->inistate) {
672 case INI_IO_ABORTED:
673 break;
674 case INI_IO_COMPLETED:
675 completed = true;
676 break;
677 default:
678 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
679 WARN_ON(1);
680 return;
681 }
682 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
683
684 if (unlikely(completed)) {
685 /* remove reference taken in original abort downcall */
686 fcloop_tfcp_req_put(tfcp_req);
687 return;
688 }
689
690 if (tfcp_req->tport->targetport)
691 nvmet_fc_rcv_fcp_abort(tfcp_req->tport->targetport,
692 &tfcp_req->tgt_fcp_req);
693
694 spin_lock_irqsave(&tfcp_req->reqlock, flags);
695 tfcp_req->fcpreq = NULL;
696 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
697
698 fcloop_call_host_done(fcpreq, tfcp_req, -ECANCELED);
699 /* call_host_done releases reference for abort downcall */
700 }
701
702 /*
703 * FCP IO operation done by target completion.
704 * call back up initiator "done" flows.
705 */
706 static void
fcloop_tgt_fcprqst_done_work(struct work_struct * work)707 fcloop_tgt_fcprqst_done_work(struct work_struct *work)
708 {
709 struct fcloop_fcpreq *tfcp_req =
710 container_of(work, struct fcloop_fcpreq, tio_done_work);
711 struct nvmefc_fcp_req *fcpreq;
712 unsigned long flags;
713
714 spin_lock_irqsave(&tfcp_req->reqlock, flags);
715 fcpreq = tfcp_req->fcpreq;
716 tfcp_req->inistate = INI_IO_COMPLETED;
717 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
718
719 fcloop_call_host_done(fcpreq, tfcp_req, tfcp_req->status);
720 }
721
722
723 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)724 fcloop_fcp_req(struct nvme_fc_local_port *localport,
725 struct nvme_fc_remote_port *remoteport,
726 void *hw_queue_handle,
727 struct nvmefc_fcp_req *fcpreq)
728 {
729 struct fcloop_rport *rport = remoteport->private;
730 struct fcloop_ini_fcpreq *inireq = fcpreq->private;
731 struct fcloop_fcpreq *tfcp_req;
732
733 if (!rport->targetport)
734 return -ECONNREFUSED;
735
736 tfcp_req = kzalloc(sizeof(*tfcp_req), GFP_ATOMIC);
737 if (!tfcp_req)
738 return -ENOMEM;
739
740 inireq->fcpreq = fcpreq;
741 inireq->tfcp_req = tfcp_req;
742 spin_lock_init(&inireq->inilock);
743
744 tfcp_req->fcpreq = fcpreq;
745 tfcp_req->tport = rport->targetport->private;
746 tfcp_req->inistate = INI_IO_START;
747 spin_lock_init(&tfcp_req->reqlock);
748 INIT_WORK(&tfcp_req->fcp_rcv_work, fcloop_fcp_recv_work);
749 INIT_WORK(&tfcp_req->abort_rcv_work, fcloop_fcp_abort_recv_work);
750 INIT_WORK(&tfcp_req->tio_done_work, fcloop_tgt_fcprqst_done_work);
751 kref_init(&tfcp_req->ref);
752
753 queue_work(nvmet_wq, &tfcp_req->fcp_rcv_work);
754
755 return 0;
756 }
757
758 static void
fcloop_fcp_copy_data(u8 op,struct scatterlist * data_sg,struct scatterlist * io_sg,u32 offset,u32 length)759 fcloop_fcp_copy_data(u8 op, struct scatterlist *data_sg,
760 struct scatterlist *io_sg, u32 offset, u32 length)
761 {
762 void *data_p, *io_p;
763 u32 data_len, io_len, tlen;
764
765 io_p = sg_virt(io_sg);
766 io_len = io_sg->length;
767
768 for ( ; offset; ) {
769 tlen = min_t(u32, offset, io_len);
770 offset -= tlen;
771 io_len -= tlen;
772 if (!io_len) {
773 io_sg = sg_next(io_sg);
774 io_p = sg_virt(io_sg);
775 io_len = io_sg->length;
776 } else
777 io_p += tlen;
778 }
779
780 data_p = sg_virt(data_sg);
781 data_len = data_sg->length;
782
783 for ( ; length; ) {
784 tlen = min_t(u32, io_len, data_len);
785 tlen = min_t(u32, tlen, length);
786
787 if (op == NVMET_FCOP_WRITEDATA)
788 memcpy(data_p, io_p, tlen);
789 else
790 memcpy(io_p, data_p, tlen);
791
792 length -= tlen;
793
794 io_len -= tlen;
795 if ((!io_len) && (length)) {
796 io_sg = sg_next(io_sg);
797 io_p = sg_virt(io_sg);
798 io_len = io_sg->length;
799 } else
800 io_p += tlen;
801
802 data_len -= tlen;
803 if ((!data_len) && (length)) {
804 data_sg = sg_next(data_sg);
805 data_p = sg_virt(data_sg);
806 data_len = data_sg->length;
807 } else
808 data_p += tlen;
809 }
810 }
811
812 static int
fcloop_fcp_op(struct nvmet_fc_target_port * tgtport,struct nvmefc_tgt_fcp_req * tgt_fcpreq)813 fcloop_fcp_op(struct nvmet_fc_target_port *tgtport,
814 struct nvmefc_tgt_fcp_req *tgt_fcpreq)
815 {
816 struct fcloop_fcpreq *tfcp_req = tgt_fcp_req_to_fcpreq(tgt_fcpreq);
817 struct nvmefc_fcp_req *fcpreq;
818 u32 rsplen = 0, xfrlen = 0;
819 int fcp_err = 0, active, aborted;
820 u8 op = tgt_fcpreq->op;
821 unsigned long flags;
822
823 spin_lock_irqsave(&tfcp_req->reqlock, flags);
824 fcpreq = tfcp_req->fcpreq;
825 active = tfcp_req->active;
826 aborted = tfcp_req->aborted;
827 tfcp_req->active = true;
828 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
829
830 if (unlikely(active))
831 /* illegal - call while i/o active */
832 return -EALREADY;
833
834 if (unlikely(aborted)) {
835 /* target transport has aborted i/o prior */
836 spin_lock_irqsave(&tfcp_req->reqlock, flags);
837 tfcp_req->active = false;
838 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
839 tgt_fcpreq->transferred_length = 0;
840 tgt_fcpreq->fcp_error = -ECANCELED;
841 tgt_fcpreq->done(tgt_fcpreq);
842 return 0;
843 }
844
845 /*
846 * if fcpreq is NULL, the I/O has been aborted (from
847 * initiator side). For the target side, act as if all is well
848 * but don't actually move data.
849 */
850
851 switch (op) {
852 case NVMET_FCOP_WRITEDATA:
853 xfrlen = tgt_fcpreq->transfer_length;
854 if (fcpreq) {
855 fcloop_fcp_copy_data(op, tgt_fcpreq->sg,
856 fcpreq->first_sgl, tgt_fcpreq->offset,
857 xfrlen);
858 fcpreq->transferred_length += xfrlen;
859 }
860 break;
861
862 case NVMET_FCOP_READDATA:
863 case NVMET_FCOP_READDATA_RSP:
864 xfrlen = tgt_fcpreq->transfer_length;
865 if (fcpreq) {
866 fcloop_fcp_copy_data(op, tgt_fcpreq->sg,
867 fcpreq->first_sgl, tgt_fcpreq->offset,
868 xfrlen);
869 fcpreq->transferred_length += xfrlen;
870 }
871 if (op == NVMET_FCOP_READDATA)
872 break;
873
874 /* Fall-Thru to RSP handling */
875 fallthrough;
876
877 case NVMET_FCOP_RSP:
878 if (fcpreq) {
879 rsplen = ((fcpreq->rsplen < tgt_fcpreq->rsplen) ?
880 fcpreq->rsplen : tgt_fcpreq->rsplen);
881 memcpy(fcpreq->rspaddr, tgt_fcpreq->rspaddr, rsplen);
882 if (rsplen < tgt_fcpreq->rsplen)
883 fcp_err = -E2BIG;
884 fcpreq->rcv_rsplen = rsplen;
885 fcpreq->status = 0;
886 }
887 tfcp_req->status = 0;
888 break;
889
890 default:
891 fcp_err = -EINVAL;
892 break;
893 }
894
895 spin_lock_irqsave(&tfcp_req->reqlock, flags);
896 tfcp_req->active = false;
897 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
898
899 tgt_fcpreq->transferred_length = xfrlen;
900 tgt_fcpreq->fcp_error = fcp_err;
901 tgt_fcpreq->done(tgt_fcpreq);
902
903 return 0;
904 }
905
906 static void
fcloop_tgt_fcp_abort(struct nvmet_fc_target_port * tgtport,struct nvmefc_tgt_fcp_req * tgt_fcpreq)907 fcloop_tgt_fcp_abort(struct nvmet_fc_target_port *tgtport,
908 struct nvmefc_tgt_fcp_req *tgt_fcpreq)
909 {
910 struct fcloop_fcpreq *tfcp_req = tgt_fcp_req_to_fcpreq(tgt_fcpreq);
911 unsigned long flags;
912
913 /*
914 * mark aborted only in case there were 2 threads in transport
915 * (one doing io, other doing abort) and only kills ops posted
916 * after the abort request
917 */
918 spin_lock_irqsave(&tfcp_req->reqlock, flags);
919 tfcp_req->aborted = true;
920 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
921
922 tfcp_req->status = NVME_SC_INTERNAL;
923
924 /*
925 * nothing more to do. If io wasn't active, the transport should
926 * immediately call the req_release. If it was active, the op
927 * will complete, and the lldd should call req_release.
928 */
929 }
930
931 static void
fcloop_fcp_req_release(struct nvmet_fc_target_port * tgtport,struct nvmefc_tgt_fcp_req * tgt_fcpreq)932 fcloop_fcp_req_release(struct nvmet_fc_target_port *tgtport,
933 struct nvmefc_tgt_fcp_req *tgt_fcpreq)
934 {
935 struct fcloop_fcpreq *tfcp_req = tgt_fcp_req_to_fcpreq(tgt_fcpreq);
936
937 queue_work(nvmet_wq, &tfcp_req->tio_done_work);
938 }
939
940 static void
fcloop_h2t_ls_abort(struct nvme_fc_local_port * localport,struct nvme_fc_remote_port * remoteport,struct nvmefc_ls_req * lsreq)941 fcloop_h2t_ls_abort(struct nvme_fc_local_port *localport,
942 struct nvme_fc_remote_port *remoteport,
943 struct nvmefc_ls_req *lsreq)
944 {
945 }
946
947 static void
fcloop_t2h_ls_abort(struct nvmet_fc_target_port * targetport,void * hosthandle,struct nvmefc_ls_req * lsreq)948 fcloop_t2h_ls_abort(struct nvmet_fc_target_port *targetport,
949 void *hosthandle, struct nvmefc_ls_req *lsreq)
950 {
951 }
952
953 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)954 fcloop_fcp_abort(struct nvme_fc_local_port *localport,
955 struct nvme_fc_remote_port *remoteport,
956 void *hw_queue_handle,
957 struct nvmefc_fcp_req *fcpreq)
958 {
959 struct fcloop_ini_fcpreq *inireq = fcpreq->private;
960 struct fcloop_fcpreq *tfcp_req;
961 bool abortio = true;
962 unsigned long flags;
963
964 spin_lock(&inireq->inilock);
965 tfcp_req = inireq->tfcp_req;
966 if (tfcp_req)
967 fcloop_tfcp_req_get(tfcp_req);
968 spin_unlock(&inireq->inilock);
969
970 if (!tfcp_req)
971 /* abort has already been called */
972 return;
973
974 /* break initiator/target relationship for io */
975 spin_lock_irqsave(&tfcp_req->reqlock, flags);
976 switch (tfcp_req->inistate) {
977 case INI_IO_START:
978 case INI_IO_ACTIVE:
979 tfcp_req->inistate = INI_IO_ABORTED;
980 break;
981 case INI_IO_COMPLETED:
982 abortio = false;
983 break;
984 default:
985 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
986 WARN_ON(1);
987 return;
988 }
989 spin_unlock_irqrestore(&tfcp_req->reqlock, flags);
990
991 if (abortio)
992 /* leave the reference while the work item is scheduled */
993 WARN_ON(!queue_work(nvmet_wq, &tfcp_req->abort_rcv_work));
994 else {
995 /*
996 * as the io has already had the done callback made,
997 * nothing more to do. So release the reference taken above
998 */
999 fcloop_tfcp_req_put(tfcp_req);
1000 }
1001 }
1002
1003 static void
fcloop_nport_free(struct kref * ref)1004 fcloop_nport_free(struct kref *ref)
1005 {
1006 struct fcloop_nport *nport =
1007 container_of(ref, struct fcloop_nport, ref);
1008
1009 kfree(nport);
1010 }
1011
1012 static void
fcloop_nport_put(struct fcloop_nport * nport)1013 fcloop_nport_put(struct fcloop_nport *nport)
1014 {
1015 kref_put(&nport->ref, fcloop_nport_free);
1016 }
1017
1018 static int
fcloop_nport_get(struct fcloop_nport * nport)1019 fcloop_nport_get(struct fcloop_nport *nport)
1020 {
1021 return kref_get_unless_zero(&nport->ref);
1022 }
1023
1024 static void
fcloop_localport_delete(struct nvme_fc_local_port * localport)1025 fcloop_localport_delete(struct nvme_fc_local_port *localport)
1026 {
1027 struct fcloop_lport_priv *lport_priv = localport->private;
1028 struct fcloop_lport *lport = lport_priv->lport;
1029
1030 /* release any threads waiting for the unreg to complete */
1031 complete(&lport->unreg_done);
1032 }
1033
1034 static void
fcloop_remoteport_delete(struct nvme_fc_remote_port * remoteport)1035 fcloop_remoteport_delete(struct nvme_fc_remote_port *remoteport)
1036 {
1037 struct fcloop_rport *rport = remoteport->private;
1038
1039 flush_work(&rport->ls_work);
1040 fcloop_nport_put(rport->nport);
1041 }
1042
1043 static void
fcloop_targetport_delete(struct nvmet_fc_target_port * targetport)1044 fcloop_targetport_delete(struct nvmet_fc_target_port *targetport)
1045 {
1046 struct fcloop_tport *tport = targetport->private;
1047
1048 flush_work(&tport->ls_work);
1049 fcloop_nport_put(tport->nport);
1050 }
1051
1052 #define FCLOOP_HW_QUEUES 4
1053 #define FCLOOP_SGL_SEGS 256
1054 #define FCLOOP_DMABOUND_4G 0xFFFFFFFF
1055
1056 static struct nvme_fc_port_template fctemplate = {
1057 .localport_delete = fcloop_localport_delete,
1058 .remoteport_delete = fcloop_remoteport_delete,
1059 .create_queue = fcloop_create_queue,
1060 .delete_queue = fcloop_delete_queue,
1061 .ls_req = fcloop_h2t_ls_req,
1062 .fcp_io = fcloop_fcp_req,
1063 .ls_abort = fcloop_h2t_ls_abort,
1064 .fcp_abort = fcloop_fcp_abort,
1065 .xmt_ls_rsp = fcloop_t2h_xmt_ls_rsp,
1066 .max_hw_queues = FCLOOP_HW_QUEUES,
1067 .max_sgl_segments = FCLOOP_SGL_SEGS,
1068 .max_dif_sgl_segments = FCLOOP_SGL_SEGS,
1069 .dma_boundary = FCLOOP_DMABOUND_4G,
1070 /* sizes of additional private data for data structures */
1071 .local_priv_sz = sizeof(struct fcloop_lport_priv),
1072 .remote_priv_sz = sizeof(struct fcloop_rport),
1073 .lsrqst_priv_sz = sizeof(struct fcloop_lsreq),
1074 .fcprqst_priv_sz = sizeof(struct fcloop_ini_fcpreq),
1075 };
1076
1077 static struct nvmet_fc_target_template tgttemplate = {
1078 .targetport_delete = fcloop_targetport_delete,
1079 .xmt_ls_rsp = fcloop_h2t_xmt_ls_rsp,
1080 .fcp_op = fcloop_fcp_op,
1081 .fcp_abort = fcloop_tgt_fcp_abort,
1082 .fcp_req_release = fcloop_fcp_req_release,
1083 .discovery_event = fcloop_tgt_discovery_evt,
1084 .ls_req = fcloop_t2h_ls_req,
1085 .ls_abort = fcloop_t2h_ls_abort,
1086 .host_release = fcloop_t2h_host_release,
1087 .host_traddr = fcloop_t2h_host_traddr,
1088 .max_hw_queues = FCLOOP_HW_QUEUES,
1089 .max_sgl_segments = FCLOOP_SGL_SEGS,
1090 .max_dif_sgl_segments = FCLOOP_SGL_SEGS,
1091 .dma_boundary = FCLOOP_DMABOUND_4G,
1092 /* optional features */
1093 .target_features = 0,
1094 /* sizes of additional private data for data structures */
1095 .target_priv_sz = sizeof(struct fcloop_tport),
1096 .lsrqst_priv_sz = sizeof(struct fcloop_lsreq),
1097 };
1098
1099 static ssize_t
fcloop_create_local_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1100 fcloop_create_local_port(struct device *dev, struct device_attribute *attr,
1101 const char *buf, size_t count)
1102 {
1103 struct nvme_fc_port_info pinfo;
1104 struct fcloop_ctrl_options *opts;
1105 struct nvme_fc_local_port *localport;
1106 struct fcloop_lport *lport;
1107 struct fcloop_lport_priv *lport_priv;
1108 unsigned long flags;
1109 int ret = -ENOMEM;
1110
1111 lport = kzalloc(sizeof(*lport), GFP_KERNEL);
1112 if (!lport)
1113 return -ENOMEM;
1114
1115 opts = kzalloc(sizeof(*opts), GFP_KERNEL);
1116 if (!opts)
1117 goto out_free_lport;
1118
1119 ret = fcloop_parse_options(opts, buf);
1120 if (ret)
1121 goto out_free_opts;
1122
1123 /* everything there ? */
1124 if ((opts->mask & LPORT_OPTS) != LPORT_OPTS) {
1125 ret = -EINVAL;
1126 goto out_free_opts;
1127 }
1128
1129 memset(&pinfo, 0, sizeof(pinfo));
1130 pinfo.node_name = opts->wwnn;
1131 pinfo.port_name = opts->wwpn;
1132 pinfo.port_role = opts->roles;
1133 pinfo.port_id = opts->fcaddr;
1134
1135 ret = nvme_fc_register_localport(&pinfo, &fctemplate, NULL, &localport);
1136 if (!ret) {
1137 /* success */
1138 lport_priv = localport->private;
1139 lport_priv->lport = lport;
1140
1141 lport->localport = localport;
1142 INIT_LIST_HEAD(&lport->lport_list);
1143
1144 spin_lock_irqsave(&fcloop_lock, flags);
1145 list_add_tail(&lport->lport_list, &fcloop_lports);
1146 spin_unlock_irqrestore(&fcloop_lock, flags);
1147 }
1148
1149 out_free_opts:
1150 kfree(opts);
1151 out_free_lport:
1152 /* free only if we're going to fail */
1153 if (ret)
1154 kfree(lport);
1155
1156 return ret ? ret : count;
1157 }
1158
1159
1160 static void
__unlink_local_port(struct fcloop_lport * lport)1161 __unlink_local_port(struct fcloop_lport *lport)
1162 {
1163 list_del(&lport->lport_list);
1164 }
1165
1166 static int
__wait_localport_unreg(struct fcloop_lport * lport)1167 __wait_localport_unreg(struct fcloop_lport *lport)
1168 {
1169 int ret;
1170
1171 init_completion(&lport->unreg_done);
1172
1173 ret = nvme_fc_unregister_localport(lport->localport);
1174
1175 if (!ret)
1176 wait_for_completion(&lport->unreg_done);
1177
1178 kfree(lport);
1179
1180 return ret;
1181 }
1182
1183
1184 static ssize_t
fcloop_delete_local_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1185 fcloop_delete_local_port(struct device *dev, struct device_attribute *attr,
1186 const char *buf, size_t count)
1187 {
1188 struct fcloop_lport *tlport, *lport = NULL;
1189 u64 nodename, portname;
1190 unsigned long flags;
1191 int ret;
1192
1193 ret = fcloop_parse_nm_options(dev, &nodename, &portname, buf);
1194 if (ret)
1195 return ret;
1196
1197 spin_lock_irqsave(&fcloop_lock, flags);
1198
1199 list_for_each_entry(tlport, &fcloop_lports, lport_list) {
1200 if (tlport->localport->node_name == nodename &&
1201 tlport->localport->port_name == portname) {
1202 lport = tlport;
1203 __unlink_local_port(lport);
1204 break;
1205 }
1206 }
1207 spin_unlock_irqrestore(&fcloop_lock, flags);
1208
1209 if (!lport)
1210 return -ENOENT;
1211
1212 ret = __wait_localport_unreg(lport);
1213
1214 return ret ? ret : count;
1215 }
1216
1217 static struct fcloop_nport *
fcloop_alloc_nport(const char * buf,size_t count,bool remoteport)1218 fcloop_alloc_nport(const char *buf, size_t count, bool remoteport)
1219 {
1220 struct fcloop_nport *newnport, *nport = NULL;
1221 struct fcloop_lport *tmplport, *lport = NULL;
1222 struct fcloop_ctrl_options *opts;
1223 unsigned long flags;
1224 u32 opts_mask = (remoteport) ? RPORT_OPTS : TGTPORT_OPTS;
1225 int ret;
1226
1227 opts = kzalloc(sizeof(*opts), GFP_KERNEL);
1228 if (!opts)
1229 return NULL;
1230
1231 ret = fcloop_parse_options(opts, buf);
1232 if (ret)
1233 goto out_free_opts;
1234
1235 /* everything there ? */
1236 if ((opts->mask & opts_mask) != opts_mask) {
1237 ret = -EINVAL;
1238 goto out_free_opts;
1239 }
1240
1241 newnport = kzalloc(sizeof(*newnport), GFP_KERNEL);
1242 if (!newnport)
1243 goto out_free_opts;
1244
1245 INIT_LIST_HEAD(&newnport->nport_list);
1246 newnport->node_name = opts->wwnn;
1247 newnport->port_name = opts->wwpn;
1248 if (opts->mask & NVMF_OPT_ROLES)
1249 newnport->port_role = opts->roles;
1250 if (opts->mask & NVMF_OPT_FCADDR)
1251 newnport->port_id = opts->fcaddr;
1252 kref_init(&newnport->ref);
1253
1254 spin_lock_irqsave(&fcloop_lock, flags);
1255
1256 list_for_each_entry(tmplport, &fcloop_lports, lport_list) {
1257 if (tmplport->localport->node_name == opts->wwnn &&
1258 tmplport->localport->port_name == opts->wwpn)
1259 goto out_invalid_opts;
1260
1261 if (tmplport->localport->node_name == opts->lpwwnn &&
1262 tmplport->localport->port_name == opts->lpwwpn)
1263 lport = tmplport;
1264 }
1265
1266 if (remoteport) {
1267 if (!lport)
1268 goto out_invalid_opts;
1269 newnport->lport = lport;
1270 }
1271
1272 list_for_each_entry(nport, &fcloop_nports, nport_list) {
1273 if (nport->node_name == opts->wwnn &&
1274 nport->port_name == opts->wwpn) {
1275 if ((remoteport && nport->rport) ||
1276 (!remoteport && nport->tport)) {
1277 nport = NULL;
1278 goto out_invalid_opts;
1279 }
1280
1281 fcloop_nport_get(nport);
1282
1283 spin_unlock_irqrestore(&fcloop_lock, flags);
1284
1285 if (remoteport)
1286 nport->lport = lport;
1287 if (opts->mask & NVMF_OPT_ROLES)
1288 nport->port_role = opts->roles;
1289 if (opts->mask & NVMF_OPT_FCADDR)
1290 nport->port_id = opts->fcaddr;
1291 goto out_free_newnport;
1292 }
1293 }
1294
1295 list_add_tail(&newnport->nport_list, &fcloop_nports);
1296
1297 spin_unlock_irqrestore(&fcloop_lock, flags);
1298
1299 kfree(opts);
1300 return newnport;
1301
1302 out_invalid_opts:
1303 spin_unlock_irqrestore(&fcloop_lock, flags);
1304 out_free_newnport:
1305 kfree(newnport);
1306 out_free_opts:
1307 kfree(opts);
1308 return nport;
1309 }
1310
1311 static ssize_t
fcloop_create_remote_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1312 fcloop_create_remote_port(struct device *dev, struct device_attribute *attr,
1313 const char *buf, size_t count)
1314 {
1315 struct nvme_fc_remote_port *remoteport;
1316 struct fcloop_nport *nport;
1317 struct fcloop_rport *rport;
1318 struct nvme_fc_port_info pinfo;
1319 int ret;
1320
1321 nport = fcloop_alloc_nport(buf, count, true);
1322 if (!nport)
1323 return -EIO;
1324
1325 memset(&pinfo, 0, sizeof(pinfo));
1326 pinfo.node_name = nport->node_name;
1327 pinfo.port_name = nport->port_name;
1328 pinfo.port_role = nport->port_role;
1329 pinfo.port_id = nport->port_id;
1330
1331 ret = nvme_fc_register_remoteport(nport->lport->localport,
1332 &pinfo, &remoteport);
1333 if (ret || !remoteport) {
1334 fcloop_nport_put(nport);
1335 return ret;
1336 }
1337
1338 /* success */
1339 rport = remoteport->private;
1340 rport->remoteport = remoteport;
1341 rport->targetport = (nport->tport) ? nport->tport->targetport : NULL;
1342 if (nport->tport) {
1343 nport->tport->remoteport = remoteport;
1344 nport->tport->lport = nport->lport;
1345 }
1346 rport->nport = nport;
1347 rport->lport = nport->lport;
1348 nport->rport = rport;
1349 spin_lock_init(&rport->lock);
1350 INIT_WORK(&rport->ls_work, fcloop_rport_lsrqst_work);
1351 INIT_LIST_HEAD(&rport->ls_list);
1352
1353 return count;
1354 }
1355
1356
1357 static struct fcloop_rport *
__unlink_remote_port(struct fcloop_nport * nport)1358 __unlink_remote_port(struct fcloop_nport *nport)
1359 {
1360 struct fcloop_rport *rport = nport->rport;
1361
1362 if (rport && nport->tport)
1363 nport->tport->remoteport = NULL;
1364 nport->rport = NULL;
1365
1366 list_del(&nport->nport_list);
1367
1368 return rport;
1369 }
1370
1371 static int
__remoteport_unreg(struct fcloop_nport * nport,struct fcloop_rport * rport)1372 __remoteport_unreg(struct fcloop_nport *nport, struct fcloop_rport *rport)
1373 {
1374 if (!rport)
1375 return -EALREADY;
1376
1377 return nvme_fc_unregister_remoteport(rport->remoteport);
1378 }
1379
1380 static ssize_t
fcloop_delete_remote_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1381 fcloop_delete_remote_port(struct device *dev, struct device_attribute *attr,
1382 const char *buf, size_t count)
1383 {
1384 struct fcloop_nport *nport = NULL, *tmpport;
1385 static struct fcloop_rport *rport;
1386 u64 nodename, portname;
1387 unsigned long flags;
1388 int ret;
1389
1390 ret = fcloop_parse_nm_options(dev, &nodename, &portname, buf);
1391 if (ret)
1392 return ret;
1393
1394 spin_lock_irqsave(&fcloop_lock, flags);
1395
1396 list_for_each_entry(tmpport, &fcloop_nports, nport_list) {
1397 if (tmpport->node_name == nodename &&
1398 tmpport->port_name == portname && tmpport->rport) {
1399 nport = tmpport;
1400 rport = __unlink_remote_port(nport);
1401 break;
1402 }
1403 }
1404
1405 spin_unlock_irqrestore(&fcloop_lock, flags);
1406
1407 if (!nport)
1408 return -ENOENT;
1409
1410 ret = __remoteport_unreg(nport, rport);
1411
1412 return ret ? ret : count;
1413 }
1414
1415 static ssize_t
fcloop_create_target_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1416 fcloop_create_target_port(struct device *dev, struct device_attribute *attr,
1417 const char *buf, size_t count)
1418 {
1419 struct nvmet_fc_target_port *targetport;
1420 struct fcloop_nport *nport;
1421 struct fcloop_tport *tport;
1422 struct nvmet_fc_port_info tinfo;
1423 int ret;
1424
1425 nport = fcloop_alloc_nport(buf, count, false);
1426 if (!nport)
1427 return -EIO;
1428
1429 tinfo.node_name = nport->node_name;
1430 tinfo.port_name = nport->port_name;
1431 tinfo.port_id = nport->port_id;
1432
1433 ret = nvmet_fc_register_targetport(&tinfo, &tgttemplate, NULL,
1434 &targetport);
1435 if (ret) {
1436 fcloop_nport_put(nport);
1437 return ret;
1438 }
1439
1440 /* success */
1441 tport = targetport->private;
1442 tport->targetport = targetport;
1443 tport->remoteport = (nport->rport) ? nport->rport->remoteport : NULL;
1444 if (nport->rport)
1445 nport->rport->targetport = targetport;
1446 tport->nport = nport;
1447 tport->lport = nport->lport;
1448 nport->tport = tport;
1449 spin_lock_init(&tport->lock);
1450 INIT_WORK(&tport->ls_work, fcloop_tport_lsrqst_work);
1451 INIT_LIST_HEAD(&tport->ls_list);
1452
1453 return count;
1454 }
1455
1456
1457 static struct fcloop_tport *
__unlink_target_port(struct fcloop_nport * nport)1458 __unlink_target_port(struct fcloop_nport *nport)
1459 {
1460 struct fcloop_tport *tport = nport->tport;
1461
1462 if (tport && nport->rport)
1463 nport->rport->targetport = NULL;
1464 nport->tport = NULL;
1465
1466 return tport;
1467 }
1468
1469 static int
__targetport_unreg(struct fcloop_nport * nport,struct fcloop_tport * tport)1470 __targetport_unreg(struct fcloop_nport *nport, struct fcloop_tport *tport)
1471 {
1472 if (!tport)
1473 return -EALREADY;
1474
1475 return nvmet_fc_unregister_targetport(tport->targetport);
1476 }
1477
1478 static ssize_t
fcloop_delete_target_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1479 fcloop_delete_target_port(struct device *dev, struct device_attribute *attr,
1480 const char *buf, size_t count)
1481 {
1482 struct fcloop_nport *nport = NULL, *tmpport;
1483 struct fcloop_tport *tport = NULL;
1484 u64 nodename, portname;
1485 unsigned long flags;
1486 int ret;
1487
1488 ret = fcloop_parse_nm_options(dev, &nodename, &portname, buf);
1489 if (ret)
1490 return ret;
1491
1492 spin_lock_irqsave(&fcloop_lock, flags);
1493
1494 list_for_each_entry(tmpport, &fcloop_nports, nport_list) {
1495 if (tmpport->node_name == nodename &&
1496 tmpport->port_name == portname && tmpport->tport) {
1497 nport = tmpport;
1498 tport = __unlink_target_port(nport);
1499 break;
1500 }
1501 }
1502
1503 spin_unlock_irqrestore(&fcloop_lock, flags);
1504
1505 if (!nport)
1506 return -ENOENT;
1507
1508 ret = __targetport_unreg(nport, tport);
1509
1510 return ret ? ret : count;
1511 }
1512
1513 static ssize_t
fcloop_set_cmd_drop(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1514 fcloop_set_cmd_drop(struct device *dev, struct device_attribute *attr,
1515 const char *buf, size_t count)
1516 {
1517 unsigned int opcode;
1518 int starting, amount;
1519
1520 if (sscanf(buf, "%x:%d:%d", &opcode, &starting, &amount) != 3)
1521 return -EBADRQC;
1522
1523 drop_current_cnt = 0;
1524 drop_fabric_opcode = (opcode & ~DROP_OPCODE_MASK) ? true : false;
1525 drop_opcode = (opcode & DROP_OPCODE_MASK);
1526 drop_instance = starting;
1527 /* the check to drop routine uses instance + count to know when
1528 * to end. Thus, if dropping 1 instance, count should be 0.
1529 * so subtract 1 from the count.
1530 */
1531 drop_amount = amount - 1;
1532
1533 pr_info("%s: DROP: Starting at instance %d of%s opcode x%x drop +%d "
1534 "instances\n",
1535 __func__, drop_instance, drop_fabric_opcode ? " fabric" : "",
1536 drop_opcode, drop_amount);
1537
1538 return count;
1539 }
1540
1541
1542 static DEVICE_ATTR(add_local_port, 0200, NULL, fcloop_create_local_port);
1543 static DEVICE_ATTR(del_local_port, 0200, NULL, fcloop_delete_local_port);
1544 static DEVICE_ATTR(add_remote_port, 0200, NULL, fcloop_create_remote_port);
1545 static DEVICE_ATTR(del_remote_port, 0200, NULL, fcloop_delete_remote_port);
1546 static DEVICE_ATTR(add_target_port, 0200, NULL, fcloop_create_target_port);
1547 static DEVICE_ATTR(del_target_port, 0200, NULL, fcloop_delete_target_port);
1548 static DEVICE_ATTR(set_cmd_drop, 0200, NULL, fcloop_set_cmd_drop);
1549
1550 static struct attribute *fcloop_dev_attrs[] = {
1551 &dev_attr_add_local_port.attr,
1552 &dev_attr_del_local_port.attr,
1553 &dev_attr_add_remote_port.attr,
1554 &dev_attr_del_remote_port.attr,
1555 &dev_attr_add_target_port.attr,
1556 &dev_attr_del_target_port.attr,
1557 &dev_attr_set_cmd_drop.attr,
1558 NULL
1559 };
1560
1561 static const struct attribute_group fclopp_dev_attrs_group = {
1562 .attrs = fcloop_dev_attrs,
1563 };
1564
1565 static const struct attribute_group *fcloop_dev_attr_groups[] = {
1566 &fclopp_dev_attrs_group,
1567 NULL,
1568 };
1569
1570 static const struct class fcloop_class = {
1571 .name = "fcloop",
1572 };
1573 static struct device *fcloop_device;
1574
1575
fcloop_init(void)1576 static int __init fcloop_init(void)
1577 {
1578 int ret;
1579
1580 ret = class_register(&fcloop_class);
1581 if (ret) {
1582 pr_err("couldn't register class fcloop\n");
1583 return ret;
1584 }
1585
1586 fcloop_device = device_create_with_groups(
1587 &fcloop_class, NULL, MKDEV(0, 0), NULL,
1588 fcloop_dev_attr_groups, "ctl");
1589 if (IS_ERR(fcloop_device)) {
1590 pr_err("couldn't create ctl device!\n");
1591 ret = PTR_ERR(fcloop_device);
1592 goto out_destroy_class;
1593 }
1594
1595 get_device(fcloop_device);
1596
1597 return 0;
1598
1599 out_destroy_class:
1600 class_unregister(&fcloop_class);
1601 return ret;
1602 }
1603
fcloop_exit(void)1604 static void __exit fcloop_exit(void)
1605 {
1606 struct fcloop_lport *lport = NULL;
1607 struct fcloop_nport *nport = NULL;
1608 struct fcloop_tport *tport;
1609 struct fcloop_rport *rport;
1610 unsigned long flags;
1611 int ret;
1612
1613 spin_lock_irqsave(&fcloop_lock, flags);
1614
1615 for (;;) {
1616 nport = list_first_entry_or_null(&fcloop_nports,
1617 typeof(*nport), nport_list);
1618 if (!nport)
1619 break;
1620
1621 tport = __unlink_target_port(nport);
1622 rport = __unlink_remote_port(nport);
1623
1624 spin_unlock_irqrestore(&fcloop_lock, flags);
1625
1626 ret = __targetport_unreg(nport, tport);
1627 if (ret)
1628 pr_warn("%s: Failed deleting target port\n", __func__);
1629
1630 ret = __remoteport_unreg(nport, rport);
1631 if (ret)
1632 pr_warn("%s: Failed deleting remote port\n", __func__);
1633
1634 spin_lock_irqsave(&fcloop_lock, flags);
1635 }
1636
1637 for (;;) {
1638 lport = list_first_entry_or_null(&fcloop_lports,
1639 typeof(*lport), lport_list);
1640 if (!lport)
1641 break;
1642
1643 __unlink_local_port(lport);
1644
1645 spin_unlock_irqrestore(&fcloop_lock, flags);
1646
1647 ret = __wait_localport_unreg(lport);
1648 if (ret)
1649 pr_warn("%s: Failed deleting local port\n", __func__);
1650
1651 spin_lock_irqsave(&fcloop_lock, flags);
1652 }
1653
1654 spin_unlock_irqrestore(&fcloop_lock, flags);
1655
1656 put_device(fcloop_device);
1657
1658 device_destroy(&fcloop_class, MKDEV(0, 0));
1659 class_unregister(&fcloop_class);
1660 }
1661
1662 module_init(fcloop_init);
1663 module_exit(fcloop_exit);
1664
1665 MODULE_DESCRIPTION("NVMe target FC loop transport driver");
1666 MODULE_LICENSE("GPL v2");
1667