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(&rport->ls_list, &tls_req->ls_list);
362 spin_unlock(&rport->lock);
363 schedule_work(&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(&rport->ls_list, &tls_req->ls_list);
395 spin_unlock(&rport->lock);
396 schedule_work(&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(&tport->ls_list, &tls_req->ls_list);
450 spin_unlock(&tport->lock);
451 schedule_work(&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 schedule_work(&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 /*
496 * Simulate reception of RSCN and converting it to a initiator transport
497 * call to rescan a remote port.
498 */
499 static void
fcloop_tgt_rscn_work(struct work_struct * work)500 fcloop_tgt_rscn_work(struct work_struct *work)
501 {
502 struct fcloop_rscn *tgt_rscn =
503 container_of(work, struct fcloop_rscn, work);
504 struct fcloop_tport *tport = tgt_rscn->tport;
505
506 if (tport->remoteport)
507 nvme_fc_rescan_remoteport(tport->remoteport);
508 kfree(tgt_rscn);
509 }
510
511 static void
fcloop_tgt_discovery_evt(struct nvmet_fc_target_port * tgtport)512 fcloop_tgt_discovery_evt(struct nvmet_fc_target_port *tgtport)
513 {
514 struct fcloop_rscn *tgt_rscn;
515
516 tgt_rscn = kzalloc(sizeof(*tgt_rscn), GFP_KERNEL);
517 if (!tgt_rscn)
518 return;
519
520 tgt_rscn->tport = tgtport->private;
521 INIT_WORK(&tgt_rscn->work, fcloop_tgt_rscn_work);
522
523 schedule_work(&tgt_rscn->work);
524 }
525
526 static void
fcloop_tfcp_req_free(struct kref * ref)527 fcloop_tfcp_req_free(struct kref *ref)
528 {
529 struct fcloop_fcpreq *tfcp_req =
530 container_of(ref, struct fcloop_fcpreq, ref);
531
532 kfree(tfcp_req);
533 }
534
535 static void
fcloop_tfcp_req_put(struct fcloop_fcpreq * tfcp_req)536 fcloop_tfcp_req_put(struct fcloop_fcpreq *tfcp_req)
537 {
538 kref_put(&tfcp_req->ref, fcloop_tfcp_req_free);
539 }
540
541 static int
fcloop_tfcp_req_get(struct fcloop_fcpreq * tfcp_req)542 fcloop_tfcp_req_get(struct fcloop_fcpreq *tfcp_req)
543 {
544 return kref_get_unless_zero(&tfcp_req->ref);
545 }
546
547 static void
fcloop_call_host_done(struct nvmefc_fcp_req * fcpreq,struct fcloop_fcpreq * tfcp_req,int status)548 fcloop_call_host_done(struct nvmefc_fcp_req *fcpreq,
549 struct fcloop_fcpreq *tfcp_req, int status)
550 {
551 struct fcloop_ini_fcpreq *inireq = NULL;
552
553 if (fcpreq) {
554 inireq = fcpreq->private;
555 spin_lock(&inireq->inilock);
556 inireq->tfcp_req = NULL;
557 spin_unlock(&inireq->inilock);
558
559 fcpreq->status = status;
560 fcpreq->done(fcpreq);
561 }
562
563 /* release original io reference on tgt struct */
564 fcloop_tfcp_req_put(tfcp_req);
565 }
566
567 static bool drop_fabric_opcode;
568 #define DROP_OPCODE_MASK 0x00FF
569 /* fabrics opcode will have a bit set above 1st byte */
570 static int drop_opcode = -1;
571 static int drop_instance;
572 static int drop_amount;
573 static int drop_current_cnt;
574
575 /*
576 * Routine to parse io and determine if the io is to be dropped.
577 * Returns:
578 * 0 if io is not obstructed
579 * 1 if io was dropped
580 */
check_for_drop(struct fcloop_fcpreq * tfcp_req)581 static int check_for_drop(struct fcloop_fcpreq *tfcp_req)
582 {
583 struct nvmefc_fcp_req *fcpreq = tfcp_req->fcpreq;
584 struct nvme_fc_cmd_iu *cmdiu = fcpreq->cmdaddr;
585 struct nvme_command *sqe = &cmdiu->sqe;
586
587 if (drop_opcode == -1)
588 return 0;
589
590 pr_info("%s: seq opcd x%02x fctype x%02x: drop F %s op x%02x "
591 "inst %d start %d amt %d\n",
592 __func__, sqe->common.opcode, sqe->fabrics.fctype,
593 drop_fabric_opcode ? "y" : "n",
594 drop_opcode, drop_current_cnt, drop_instance, drop_amount);
595
596 if ((drop_fabric_opcode &&
597 (sqe->common.opcode != nvme_fabrics_command ||
598 sqe->fabrics.fctype != drop_opcode)) ||
599 (!drop_fabric_opcode && sqe->common.opcode != drop_opcode))
600 return 0;
601
602 if (++drop_current_cnt >= drop_instance) {
603 if (drop_current_cnt >= drop_instance + drop_amount)
604 drop_opcode = -1;
605 return 1;
606 }
607
608 return 0;
609 }
610
611 static void
fcloop_fcp_recv_work(struct work_struct * work)612 fcloop_fcp_recv_work(struct work_struct *work)
613 {
614 struct fcloop_fcpreq *tfcp_req =
615 container_of(work, struct fcloop_fcpreq, fcp_rcv_work);
616 struct nvmefc_fcp_req *fcpreq = tfcp_req->fcpreq;
617 int ret = 0;
618 bool aborted = false;
619
620 spin_lock_irq(&tfcp_req->reqlock);
621 switch (tfcp_req->inistate) {
622 case INI_IO_START:
623 tfcp_req->inistate = INI_IO_ACTIVE;
624 break;
625 case INI_IO_ABORTED:
626 aborted = true;
627 break;
628 default:
629 spin_unlock_irq(&tfcp_req->reqlock);
630 WARN_ON(1);
631 return;
632 }
633 spin_unlock_irq(&tfcp_req->reqlock);
634
635 if (unlikely(aborted))
636 ret = -ECANCELED;
637 else {
638 if (likely(!check_for_drop(tfcp_req)))
639 ret = nvmet_fc_rcv_fcp_req(tfcp_req->tport->targetport,
640 &tfcp_req->tgt_fcp_req,
641 fcpreq->cmdaddr, fcpreq->cmdlen);
642 else
643 pr_info("%s: dropped command ********\n", __func__);
644 }
645 if (ret)
646 fcloop_call_host_done(fcpreq, tfcp_req, ret);
647
648 return;
649 }
650
651 static void
fcloop_fcp_abort_recv_work(struct work_struct * work)652 fcloop_fcp_abort_recv_work(struct work_struct *work)
653 {
654 struct fcloop_fcpreq *tfcp_req =
655 container_of(work, struct fcloop_fcpreq, abort_rcv_work);
656 struct nvmefc_fcp_req *fcpreq;
657 bool completed = false;
658
659 spin_lock_irq(&tfcp_req->reqlock);
660 fcpreq = tfcp_req->fcpreq;
661 switch (tfcp_req->inistate) {
662 case INI_IO_ABORTED:
663 break;
664 case INI_IO_COMPLETED:
665 completed = true;
666 break;
667 default:
668 spin_unlock_irq(&tfcp_req->reqlock);
669 WARN_ON(1);
670 return;
671 }
672 spin_unlock_irq(&tfcp_req->reqlock);
673
674 if (unlikely(completed)) {
675 /* remove reference taken in original abort downcall */
676 fcloop_tfcp_req_put(tfcp_req);
677 return;
678 }
679
680 if (tfcp_req->tport->targetport)
681 nvmet_fc_rcv_fcp_abort(tfcp_req->tport->targetport,
682 &tfcp_req->tgt_fcp_req);
683
684 spin_lock_irq(&tfcp_req->reqlock);
685 tfcp_req->fcpreq = NULL;
686 spin_unlock_irq(&tfcp_req->reqlock);
687
688 fcloop_call_host_done(fcpreq, tfcp_req, -ECANCELED);
689 /* call_host_done releases reference for abort downcall */
690 }
691
692 /*
693 * FCP IO operation done by target completion.
694 * call back up initiator "done" flows.
695 */
696 static void
fcloop_tgt_fcprqst_done_work(struct work_struct * work)697 fcloop_tgt_fcprqst_done_work(struct work_struct *work)
698 {
699 struct fcloop_fcpreq *tfcp_req =
700 container_of(work, struct fcloop_fcpreq, tio_done_work);
701 struct nvmefc_fcp_req *fcpreq;
702
703 spin_lock_irq(&tfcp_req->reqlock);
704 fcpreq = tfcp_req->fcpreq;
705 tfcp_req->inistate = INI_IO_COMPLETED;
706 spin_unlock_irq(&tfcp_req->reqlock);
707
708 fcloop_call_host_done(fcpreq, tfcp_req, tfcp_req->status);
709 }
710
711
712 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)713 fcloop_fcp_req(struct nvme_fc_local_port *localport,
714 struct nvme_fc_remote_port *remoteport,
715 void *hw_queue_handle,
716 struct nvmefc_fcp_req *fcpreq)
717 {
718 struct fcloop_rport *rport = remoteport->private;
719 struct fcloop_ini_fcpreq *inireq = fcpreq->private;
720 struct fcloop_fcpreq *tfcp_req;
721
722 if (!rport->targetport)
723 return -ECONNREFUSED;
724
725 tfcp_req = kzalloc(sizeof(*tfcp_req), GFP_ATOMIC);
726 if (!tfcp_req)
727 return -ENOMEM;
728
729 inireq->fcpreq = fcpreq;
730 inireq->tfcp_req = tfcp_req;
731 spin_lock_init(&inireq->inilock);
732
733 tfcp_req->fcpreq = fcpreq;
734 tfcp_req->tport = rport->targetport->private;
735 tfcp_req->inistate = INI_IO_START;
736 spin_lock_init(&tfcp_req->reqlock);
737 INIT_WORK(&tfcp_req->fcp_rcv_work, fcloop_fcp_recv_work);
738 INIT_WORK(&tfcp_req->abort_rcv_work, fcloop_fcp_abort_recv_work);
739 INIT_WORK(&tfcp_req->tio_done_work, fcloop_tgt_fcprqst_done_work);
740 kref_init(&tfcp_req->ref);
741
742 schedule_work(&tfcp_req->fcp_rcv_work);
743
744 return 0;
745 }
746
747 static void
fcloop_fcp_copy_data(u8 op,struct scatterlist * data_sg,struct scatterlist * io_sg,u32 offset,u32 length)748 fcloop_fcp_copy_data(u8 op, struct scatterlist *data_sg,
749 struct scatterlist *io_sg, u32 offset, u32 length)
750 {
751 void *data_p, *io_p;
752 u32 data_len, io_len, tlen;
753
754 io_p = sg_virt(io_sg);
755 io_len = io_sg->length;
756
757 for ( ; offset; ) {
758 tlen = min_t(u32, offset, io_len);
759 offset -= tlen;
760 io_len -= tlen;
761 if (!io_len) {
762 io_sg = sg_next(io_sg);
763 io_p = sg_virt(io_sg);
764 io_len = io_sg->length;
765 } else
766 io_p += tlen;
767 }
768
769 data_p = sg_virt(data_sg);
770 data_len = data_sg->length;
771
772 for ( ; length; ) {
773 tlen = min_t(u32, io_len, data_len);
774 tlen = min_t(u32, tlen, length);
775
776 if (op == NVMET_FCOP_WRITEDATA)
777 memcpy(data_p, io_p, tlen);
778 else
779 memcpy(io_p, data_p, tlen);
780
781 length -= tlen;
782
783 io_len -= tlen;
784 if ((!io_len) && (length)) {
785 io_sg = sg_next(io_sg);
786 io_p = sg_virt(io_sg);
787 io_len = io_sg->length;
788 } else
789 io_p += tlen;
790
791 data_len -= tlen;
792 if ((!data_len) && (length)) {
793 data_sg = sg_next(data_sg);
794 data_p = sg_virt(data_sg);
795 data_len = data_sg->length;
796 } else
797 data_p += tlen;
798 }
799 }
800
801 static int
fcloop_fcp_op(struct nvmet_fc_target_port * tgtport,struct nvmefc_tgt_fcp_req * tgt_fcpreq)802 fcloop_fcp_op(struct nvmet_fc_target_port *tgtport,
803 struct nvmefc_tgt_fcp_req *tgt_fcpreq)
804 {
805 struct fcloop_fcpreq *tfcp_req = tgt_fcp_req_to_fcpreq(tgt_fcpreq);
806 struct nvmefc_fcp_req *fcpreq;
807 u32 rsplen = 0, xfrlen = 0;
808 int fcp_err = 0, active, aborted;
809 u8 op = tgt_fcpreq->op;
810
811 spin_lock_irq(&tfcp_req->reqlock);
812 fcpreq = tfcp_req->fcpreq;
813 active = tfcp_req->active;
814 aborted = tfcp_req->aborted;
815 tfcp_req->active = true;
816 spin_unlock_irq(&tfcp_req->reqlock);
817
818 if (unlikely(active))
819 /* illegal - call while i/o active */
820 return -EALREADY;
821
822 if (unlikely(aborted)) {
823 /* target transport has aborted i/o prior */
824 spin_lock_irq(&tfcp_req->reqlock);
825 tfcp_req->active = false;
826 spin_unlock_irq(&tfcp_req->reqlock);
827 tgt_fcpreq->transferred_length = 0;
828 tgt_fcpreq->fcp_error = -ECANCELED;
829 tgt_fcpreq->done(tgt_fcpreq);
830 return 0;
831 }
832
833 /*
834 * if fcpreq is NULL, the I/O has been aborted (from
835 * initiator side). For the target side, act as if all is well
836 * but don't actually move data.
837 */
838
839 switch (op) {
840 case NVMET_FCOP_WRITEDATA:
841 xfrlen = tgt_fcpreq->transfer_length;
842 if (fcpreq) {
843 fcloop_fcp_copy_data(op, tgt_fcpreq->sg,
844 fcpreq->first_sgl, tgt_fcpreq->offset,
845 xfrlen);
846 fcpreq->transferred_length += xfrlen;
847 }
848 break;
849
850 case NVMET_FCOP_READDATA:
851 case NVMET_FCOP_READDATA_RSP:
852 xfrlen = tgt_fcpreq->transfer_length;
853 if (fcpreq) {
854 fcloop_fcp_copy_data(op, tgt_fcpreq->sg,
855 fcpreq->first_sgl, tgt_fcpreq->offset,
856 xfrlen);
857 fcpreq->transferred_length += xfrlen;
858 }
859 if (op == NVMET_FCOP_READDATA)
860 break;
861
862 /* Fall-Thru to RSP handling */
863 fallthrough;
864
865 case NVMET_FCOP_RSP:
866 if (fcpreq) {
867 rsplen = ((fcpreq->rsplen < tgt_fcpreq->rsplen) ?
868 fcpreq->rsplen : tgt_fcpreq->rsplen);
869 memcpy(fcpreq->rspaddr, tgt_fcpreq->rspaddr, rsplen);
870 if (rsplen < tgt_fcpreq->rsplen)
871 fcp_err = -E2BIG;
872 fcpreq->rcv_rsplen = rsplen;
873 fcpreq->status = 0;
874 }
875 tfcp_req->status = 0;
876 break;
877
878 default:
879 fcp_err = -EINVAL;
880 break;
881 }
882
883 spin_lock_irq(&tfcp_req->reqlock);
884 tfcp_req->active = false;
885 spin_unlock_irq(&tfcp_req->reqlock);
886
887 tgt_fcpreq->transferred_length = xfrlen;
888 tgt_fcpreq->fcp_error = fcp_err;
889 tgt_fcpreq->done(tgt_fcpreq);
890
891 return 0;
892 }
893
894 static void
fcloop_tgt_fcp_abort(struct nvmet_fc_target_port * tgtport,struct nvmefc_tgt_fcp_req * tgt_fcpreq)895 fcloop_tgt_fcp_abort(struct nvmet_fc_target_port *tgtport,
896 struct nvmefc_tgt_fcp_req *tgt_fcpreq)
897 {
898 struct fcloop_fcpreq *tfcp_req = tgt_fcp_req_to_fcpreq(tgt_fcpreq);
899
900 /*
901 * mark aborted only in case there were 2 threads in transport
902 * (one doing io, other doing abort) and only kills ops posted
903 * after the abort request
904 */
905 spin_lock_irq(&tfcp_req->reqlock);
906 tfcp_req->aborted = true;
907 spin_unlock_irq(&tfcp_req->reqlock);
908
909 tfcp_req->status = NVME_SC_INTERNAL;
910
911 /*
912 * nothing more to do. If io wasn't active, the transport should
913 * immediately call the req_release. If it was active, the op
914 * will complete, and the lldd should call req_release.
915 */
916 }
917
918 static void
fcloop_fcp_req_release(struct nvmet_fc_target_port * tgtport,struct nvmefc_tgt_fcp_req * tgt_fcpreq)919 fcloop_fcp_req_release(struct nvmet_fc_target_port *tgtport,
920 struct nvmefc_tgt_fcp_req *tgt_fcpreq)
921 {
922 struct fcloop_fcpreq *tfcp_req = tgt_fcp_req_to_fcpreq(tgt_fcpreq);
923
924 schedule_work(&tfcp_req->tio_done_work);
925 }
926
927 static void
fcloop_h2t_ls_abort(struct nvme_fc_local_port * localport,struct nvme_fc_remote_port * remoteport,struct nvmefc_ls_req * lsreq)928 fcloop_h2t_ls_abort(struct nvme_fc_local_port *localport,
929 struct nvme_fc_remote_port *remoteport,
930 struct nvmefc_ls_req *lsreq)
931 {
932 }
933
934 static void
fcloop_t2h_ls_abort(struct nvmet_fc_target_port * targetport,void * hosthandle,struct nvmefc_ls_req * lsreq)935 fcloop_t2h_ls_abort(struct nvmet_fc_target_port *targetport,
936 void *hosthandle, struct nvmefc_ls_req *lsreq)
937 {
938 }
939
940 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)941 fcloop_fcp_abort(struct nvme_fc_local_port *localport,
942 struct nvme_fc_remote_port *remoteport,
943 void *hw_queue_handle,
944 struct nvmefc_fcp_req *fcpreq)
945 {
946 struct fcloop_ini_fcpreq *inireq = fcpreq->private;
947 struct fcloop_fcpreq *tfcp_req;
948 bool abortio = true;
949
950 spin_lock(&inireq->inilock);
951 tfcp_req = inireq->tfcp_req;
952 if (tfcp_req)
953 fcloop_tfcp_req_get(tfcp_req);
954 spin_unlock(&inireq->inilock);
955
956 if (!tfcp_req)
957 /* abort has already been called */
958 return;
959
960 /* break initiator/target relationship for io */
961 spin_lock_irq(&tfcp_req->reqlock);
962 switch (tfcp_req->inistate) {
963 case INI_IO_START:
964 case INI_IO_ACTIVE:
965 tfcp_req->inistate = INI_IO_ABORTED;
966 break;
967 case INI_IO_COMPLETED:
968 abortio = false;
969 break;
970 default:
971 spin_unlock_irq(&tfcp_req->reqlock);
972 WARN_ON(1);
973 return;
974 }
975 spin_unlock_irq(&tfcp_req->reqlock);
976
977 if (abortio)
978 /* leave the reference while the work item is scheduled */
979 WARN_ON(!schedule_work(&tfcp_req->abort_rcv_work));
980 else {
981 /*
982 * as the io has already had the done callback made,
983 * nothing more to do. So release the reference taken above
984 */
985 fcloop_tfcp_req_put(tfcp_req);
986 }
987 }
988
989 static void
fcloop_nport_free(struct kref * ref)990 fcloop_nport_free(struct kref *ref)
991 {
992 struct fcloop_nport *nport =
993 container_of(ref, struct fcloop_nport, ref);
994 unsigned long flags;
995
996 spin_lock_irqsave(&fcloop_lock, flags);
997 list_del(&nport->nport_list);
998 spin_unlock_irqrestore(&fcloop_lock, flags);
999
1000 kfree(nport);
1001 }
1002
1003 static void
fcloop_nport_put(struct fcloop_nport * nport)1004 fcloop_nport_put(struct fcloop_nport *nport)
1005 {
1006 kref_put(&nport->ref, fcloop_nport_free);
1007 }
1008
1009 static int
fcloop_nport_get(struct fcloop_nport * nport)1010 fcloop_nport_get(struct fcloop_nport *nport)
1011 {
1012 return kref_get_unless_zero(&nport->ref);
1013 }
1014
1015 static void
fcloop_localport_delete(struct nvme_fc_local_port * localport)1016 fcloop_localport_delete(struct nvme_fc_local_port *localport)
1017 {
1018 struct fcloop_lport_priv *lport_priv = localport->private;
1019 struct fcloop_lport *lport = lport_priv->lport;
1020
1021 /* release any threads waiting for the unreg to complete */
1022 complete(&lport->unreg_done);
1023 }
1024
1025 static void
fcloop_remoteport_delete(struct nvme_fc_remote_port * remoteport)1026 fcloop_remoteport_delete(struct nvme_fc_remote_port *remoteport)
1027 {
1028 struct fcloop_rport *rport = remoteport->private;
1029
1030 flush_work(&rport->ls_work);
1031 fcloop_nport_put(rport->nport);
1032 }
1033
1034 static void
fcloop_targetport_delete(struct nvmet_fc_target_port * targetport)1035 fcloop_targetport_delete(struct nvmet_fc_target_port *targetport)
1036 {
1037 struct fcloop_tport *tport = targetport->private;
1038
1039 flush_work(&tport->ls_work);
1040 fcloop_nport_put(tport->nport);
1041 }
1042
1043 #define FCLOOP_HW_QUEUES 4
1044 #define FCLOOP_SGL_SEGS 256
1045 #define FCLOOP_DMABOUND_4G 0xFFFFFFFF
1046
1047 static struct nvme_fc_port_template fctemplate = {
1048 .localport_delete = fcloop_localport_delete,
1049 .remoteport_delete = fcloop_remoteport_delete,
1050 .create_queue = fcloop_create_queue,
1051 .delete_queue = fcloop_delete_queue,
1052 .ls_req = fcloop_h2t_ls_req,
1053 .fcp_io = fcloop_fcp_req,
1054 .ls_abort = fcloop_h2t_ls_abort,
1055 .fcp_abort = fcloop_fcp_abort,
1056 .xmt_ls_rsp = fcloop_t2h_xmt_ls_rsp,
1057 .max_hw_queues = FCLOOP_HW_QUEUES,
1058 .max_sgl_segments = FCLOOP_SGL_SEGS,
1059 .max_dif_sgl_segments = FCLOOP_SGL_SEGS,
1060 .dma_boundary = FCLOOP_DMABOUND_4G,
1061 /* sizes of additional private data for data structures */
1062 .local_priv_sz = sizeof(struct fcloop_lport_priv),
1063 .remote_priv_sz = sizeof(struct fcloop_rport),
1064 .lsrqst_priv_sz = sizeof(struct fcloop_lsreq),
1065 .fcprqst_priv_sz = sizeof(struct fcloop_ini_fcpreq),
1066 };
1067
1068 static struct nvmet_fc_target_template tgttemplate = {
1069 .targetport_delete = fcloop_targetport_delete,
1070 .xmt_ls_rsp = fcloop_h2t_xmt_ls_rsp,
1071 .fcp_op = fcloop_fcp_op,
1072 .fcp_abort = fcloop_tgt_fcp_abort,
1073 .fcp_req_release = fcloop_fcp_req_release,
1074 .discovery_event = fcloop_tgt_discovery_evt,
1075 .ls_req = fcloop_t2h_ls_req,
1076 .ls_abort = fcloop_t2h_ls_abort,
1077 .host_release = fcloop_t2h_host_release,
1078 .max_hw_queues = FCLOOP_HW_QUEUES,
1079 .max_sgl_segments = FCLOOP_SGL_SEGS,
1080 .max_dif_sgl_segments = FCLOOP_SGL_SEGS,
1081 .dma_boundary = FCLOOP_DMABOUND_4G,
1082 /* optional features */
1083 .target_features = 0,
1084 /* sizes of additional private data for data structures */
1085 .target_priv_sz = sizeof(struct fcloop_tport),
1086 .lsrqst_priv_sz = sizeof(struct fcloop_lsreq),
1087 };
1088
1089 static ssize_t
fcloop_create_local_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1090 fcloop_create_local_port(struct device *dev, struct device_attribute *attr,
1091 const char *buf, size_t count)
1092 {
1093 struct nvme_fc_port_info pinfo;
1094 struct fcloop_ctrl_options *opts;
1095 struct nvme_fc_local_port *localport;
1096 struct fcloop_lport *lport;
1097 struct fcloop_lport_priv *lport_priv;
1098 unsigned long flags;
1099 int ret = -ENOMEM;
1100
1101 lport = kzalloc(sizeof(*lport), GFP_KERNEL);
1102 if (!lport)
1103 return -ENOMEM;
1104
1105 opts = kzalloc(sizeof(*opts), GFP_KERNEL);
1106 if (!opts)
1107 goto out_free_lport;
1108
1109 ret = fcloop_parse_options(opts, buf);
1110 if (ret)
1111 goto out_free_opts;
1112
1113 /* everything there ? */
1114 if ((opts->mask & LPORT_OPTS) != LPORT_OPTS) {
1115 ret = -EINVAL;
1116 goto out_free_opts;
1117 }
1118
1119 memset(&pinfo, 0, sizeof(pinfo));
1120 pinfo.node_name = opts->wwnn;
1121 pinfo.port_name = opts->wwpn;
1122 pinfo.port_role = opts->roles;
1123 pinfo.port_id = opts->fcaddr;
1124
1125 ret = nvme_fc_register_localport(&pinfo, &fctemplate, NULL, &localport);
1126 if (!ret) {
1127 /* success */
1128 lport_priv = localport->private;
1129 lport_priv->lport = lport;
1130
1131 lport->localport = localport;
1132 INIT_LIST_HEAD(&lport->lport_list);
1133
1134 spin_lock_irqsave(&fcloop_lock, flags);
1135 list_add_tail(&lport->lport_list, &fcloop_lports);
1136 spin_unlock_irqrestore(&fcloop_lock, flags);
1137 }
1138
1139 out_free_opts:
1140 kfree(opts);
1141 out_free_lport:
1142 /* free only if we're going to fail */
1143 if (ret)
1144 kfree(lport);
1145
1146 return ret ? ret : count;
1147 }
1148
1149
1150 static void
__unlink_local_port(struct fcloop_lport * lport)1151 __unlink_local_port(struct fcloop_lport *lport)
1152 {
1153 list_del(&lport->lport_list);
1154 }
1155
1156 static int
__wait_localport_unreg(struct fcloop_lport * lport)1157 __wait_localport_unreg(struct fcloop_lport *lport)
1158 {
1159 int ret;
1160
1161 init_completion(&lport->unreg_done);
1162
1163 ret = nvme_fc_unregister_localport(lport->localport);
1164
1165 wait_for_completion(&lport->unreg_done);
1166
1167 kfree(lport);
1168
1169 return ret;
1170 }
1171
1172
1173 static ssize_t
fcloop_delete_local_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1174 fcloop_delete_local_port(struct device *dev, struct device_attribute *attr,
1175 const char *buf, size_t count)
1176 {
1177 struct fcloop_lport *tlport, *lport = NULL;
1178 u64 nodename, portname;
1179 unsigned long flags;
1180 int ret;
1181
1182 ret = fcloop_parse_nm_options(dev, &nodename, &portname, buf);
1183 if (ret)
1184 return ret;
1185
1186 spin_lock_irqsave(&fcloop_lock, flags);
1187
1188 list_for_each_entry(tlport, &fcloop_lports, lport_list) {
1189 if (tlport->localport->node_name == nodename &&
1190 tlport->localport->port_name == portname) {
1191 lport = tlport;
1192 __unlink_local_port(lport);
1193 break;
1194 }
1195 }
1196 spin_unlock_irqrestore(&fcloop_lock, flags);
1197
1198 if (!lport)
1199 return -ENOENT;
1200
1201 ret = __wait_localport_unreg(lport);
1202
1203 return ret ? ret : count;
1204 }
1205
1206 static struct fcloop_nport *
fcloop_alloc_nport(const char * buf,size_t count,bool remoteport)1207 fcloop_alloc_nport(const char *buf, size_t count, bool remoteport)
1208 {
1209 struct fcloop_nport *newnport, *nport = NULL;
1210 struct fcloop_lport *tmplport, *lport = NULL;
1211 struct fcloop_ctrl_options *opts;
1212 unsigned long flags;
1213 u32 opts_mask = (remoteport) ? RPORT_OPTS : TGTPORT_OPTS;
1214 int ret;
1215
1216 opts = kzalloc(sizeof(*opts), GFP_KERNEL);
1217 if (!opts)
1218 return NULL;
1219
1220 ret = fcloop_parse_options(opts, buf);
1221 if (ret)
1222 goto out_free_opts;
1223
1224 /* everything there ? */
1225 if ((opts->mask & opts_mask) != opts_mask) {
1226 ret = -EINVAL;
1227 goto out_free_opts;
1228 }
1229
1230 newnport = kzalloc(sizeof(*newnport), GFP_KERNEL);
1231 if (!newnport)
1232 goto out_free_opts;
1233
1234 INIT_LIST_HEAD(&newnport->nport_list);
1235 newnport->node_name = opts->wwnn;
1236 newnport->port_name = opts->wwpn;
1237 if (opts->mask & NVMF_OPT_ROLES)
1238 newnport->port_role = opts->roles;
1239 if (opts->mask & NVMF_OPT_FCADDR)
1240 newnport->port_id = opts->fcaddr;
1241 kref_init(&newnport->ref);
1242
1243 spin_lock_irqsave(&fcloop_lock, flags);
1244
1245 list_for_each_entry(tmplport, &fcloop_lports, lport_list) {
1246 if (tmplport->localport->node_name == opts->wwnn &&
1247 tmplport->localport->port_name == opts->wwpn)
1248 goto out_invalid_opts;
1249
1250 if (tmplport->localport->node_name == opts->lpwwnn &&
1251 tmplport->localport->port_name == opts->lpwwpn)
1252 lport = tmplport;
1253 }
1254
1255 if (remoteport) {
1256 if (!lport)
1257 goto out_invalid_opts;
1258 newnport->lport = lport;
1259 }
1260
1261 list_for_each_entry(nport, &fcloop_nports, nport_list) {
1262 if (nport->node_name == opts->wwnn &&
1263 nport->port_name == opts->wwpn) {
1264 if ((remoteport && nport->rport) ||
1265 (!remoteport && nport->tport)) {
1266 nport = NULL;
1267 goto out_invalid_opts;
1268 }
1269
1270 fcloop_nport_get(nport);
1271
1272 spin_unlock_irqrestore(&fcloop_lock, flags);
1273
1274 if (remoteport)
1275 nport->lport = lport;
1276 if (opts->mask & NVMF_OPT_ROLES)
1277 nport->port_role = opts->roles;
1278 if (opts->mask & NVMF_OPT_FCADDR)
1279 nport->port_id = opts->fcaddr;
1280 goto out_free_newnport;
1281 }
1282 }
1283
1284 list_add_tail(&newnport->nport_list, &fcloop_nports);
1285
1286 spin_unlock_irqrestore(&fcloop_lock, flags);
1287
1288 kfree(opts);
1289 return newnport;
1290
1291 out_invalid_opts:
1292 spin_unlock_irqrestore(&fcloop_lock, flags);
1293 out_free_newnport:
1294 kfree(newnport);
1295 out_free_opts:
1296 kfree(opts);
1297 return nport;
1298 }
1299
1300 static ssize_t
fcloop_create_remote_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1301 fcloop_create_remote_port(struct device *dev, struct device_attribute *attr,
1302 const char *buf, size_t count)
1303 {
1304 struct nvme_fc_remote_port *remoteport;
1305 struct fcloop_nport *nport;
1306 struct fcloop_rport *rport;
1307 struct nvme_fc_port_info pinfo;
1308 int ret;
1309
1310 nport = fcloop_alloc_nport(buf, count, true);
1311 if (!nport)
1312 return -EIO;
1313
1314 memset(&pinfo, 0, sizeof(pinfo));
1315 pinfo.node_name = nport->node_name;
1316 pinfo.port_name = nport->port_name;
1317 pinfo.port_role = nport->port_role;
1318 pinfo.port_id = nport->port_id;
1319
1320 ret = nvme_fc_register_remoteport(nport->lport->localport,
1321 &pinfo, &remoteport);
1322 if (ret || !remoteport) {
1323 fcloop_nport_put(nport);
1324 return ret;
1325 }
1326
1327 /* success */
1328 rport = remoteport->private;
1329 rport->remoteport = remoteport;
1330 rport->targetport = (nport->tport) ? nport->tport->targetport : NULL;
1331 if (nport->tport) {
1332 nport->tport->remoteport = remoteport;
1333 nport->tport->lport = nport->lport;
1334 }
1335 rport->nport = nport;
1336 rport->lport = nport->lport;
1337 nport->rport = rport;
1338 spin_lock_init(&rport->lock);
1339 INIT_WORK(&rport->ls_work, fcloop_rport_lsrqst_work);
1340 INIT_LIST_HEAD(&rport->ls_list);
1341
1342 return count;
1343 }
1344
1345
1346 static struct fcloop_rport *
__unlink_remote_port(struct fcloop_nport * nport)1347 __unlink_remote_port(struct fcloop_nport *nport)
1348 {
1349 struct fcloop_rport *rport = nport->rport;
1350
1351 if (rport && nport->tport)
1352 nport->tport->remoteport = NULL;
1353 nport->rport = NULL;
1354
1355 return rport;
1356 }
1357
1358 static int
__remoteport_unreg(struct fcloop_nport * nport,struct fcloop_rport * rport)1359 __remoteport_unreg(struct fcloop_nport *nport, struct fcloop_rport *rport)
1360 {
1361 if (!rport)
1362 return -EALREADY;
1363
1364 return nvme_fc_unregister_remoteport(rport->remoteport);
1365 }
1366
1367 static ssize_t
fcloop_delete_remote_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1368 fcloop_delete_remote_port(struct device *dev, struct device_attribute *attr,
1369 const char *buf, size_t count)
1370 {
1371 struct fcloop_nport *nport = NULL, *tmpport;
1372 static struct fcloop_rport *rport;
1373 u64 nodename, portname;
1374 unsigned long flags;
1375 int ret;
1376
1377 ret = fcloop_parse_nm_options(dev, &nodename, &portname, buf);
1378 if (ret)
1379 return ret;
1380
1381 spin_lock_irqsave(&fcloop_lock, flags);
1382
1383 list_for_each_entry(tmpport, &fcloop_nports, nport_list) {
1384 if (tmpport->node_name == nodename &&
1385 tmpport->port_name == portname && tmpport->rport) {
1386 nport = tmpport;
1387 rport = __unlink_remote_port(nport);
1388 break;
1389 }
1390 }
1391
1392 spin_unlock_irqrestore(&fcloop_lock, flags);
1393
1394 if (!nport)
1395 return -ENOENT;
1396
1397 ret = __remoteport_unreg(nport, rport);
1398
1399 return ret ? ret : count;
1400 }
1401
1402 static ssize_t
fcloop_create_target_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1403 fcloop_create_target_port(struct device *dev, struct device_attribute *attr,
1404 const char *buf, size_t count)
1405 {
1406 struct nvmet_fc_target_port *targetport;
1407 struct fcloop_nport *nport;
1408 struct fcloop_tport *tport;
1409 struct nvmet_fc_port_info tinfo;
1410 int ret;
1411
1412 nport = fcloop_alloc_nport(buf, count, false);
1413 if (!nport)
1414 return -EIO;
1415
1416 tinfo.node_name = nport->node_name;
1417 tinfo.port_name = nport->port_name;
1418 tinfo.port_id = nport->port_id;
1419
1420 ret = nvmet_fc_register_targetport(&tinfo, &tgttemplate, NULL,
1421 &targetport);
1422 if (ret) {
1423 fcloop_nport_put(nport);
1424 return ret;
1425 }
1426
1427 /* success */
1428 tport = targetport->private;
1429 tport->targetport = targetport;
1430 tport->remoteport = (nport->rport) ? nport->rport->remoteport : NULL;
1431 if (nport->rport)
1432 nport->rport->targetport = targetport;
1433 tport->nport = nport;
1434 tport->lport = nport->lport;
1435 nport->tport = tport;
1436 spin_lock_init(&tport->lock);
1437 INIT_WORK(&tport->ls_work, fcloop_tport_lsrqst_work);
1438 INIT_LIST_HEAD(&tport->ls_list);
1439
1440 return count;
1441 }
1442
1443
1444 static struct fcloop_tport *
__unlink_target_port(struct fcloop_nport * nport)1445 __unlink_target_port(struct fcloop_nport *nport)
1446 {
1447 struct fcloop_tport *tport = nport->tport;
1448
1449 if (tport && nport->rport)
1450 nport->rport->targetport = NULL;
1451 nport->tport = NULL;
1452
1453 return tport;
1454 }
1455
1456 static int
__targetport_unreg(struct fcloop_nport * nport,struct fcloop_tport * tport)1457 __targetport_unreg(struct fcloop_nport *nport, struct fcloop_tport *tport)
1458 {
1459 if (!tport)
1460 return -EALREADY;
1461
1462 return nvmet_fc_unregister_targetport(tport->targetport);
1463 }
1464
1465 static ssize_t
fcloop_delete_target_port(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1466 fcloop_delete_target_port(struct device *dev, struct device_attribute *attr,
1467 const char *buf, size_t count)
1468 {
1469 struct fcloop_nport *nport = NULL, *tmpport;
1470 struct fcloop_tport *tport = NULL;
1471 u64 nodename, portname;
1472 unsigned long flags;
1473 int ret;
1474
1475 ret = fcloop_parse_nm_options(dev, &nodename, &portname, buf);
1476 if (ret)
1477 return ret;
1478
1479 spin_lock_irqsave(&fcloop_lock, flags);
1480
1481 list_for_each_entry(tmpport, &fcloop_nports, nport_list) {
1482 if (tmpport->node_name == nodename &&
1483 tmpport->port_name == portname && tmpport->tport) {
1484 nport = tmpport;
1485 tport = __unlink_target_port(nport);
1486 break;
1487 }
1488 }
1489
1490 spin_unlock_irqrestore(&fcloop_lock, flags);
1491
1492 if (!nport)
1493 return -ENOENT;
1494
1495 ret = __targetport_unreg(nport, tport);
1496
1497 return ret ? ret : count;
1498 }
1499
1500 static ssize_t
fcloop_set_cmd_drop(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1501 fcloop_set_cmd_drop(struct device *dev, struct device_attribute *attr,
1502 const char *buf, size_t count)
1503 {
1504 unsigned int opcode;
1505 int starting, amount;
1506
1507 if (sscanf(buf, "%x:%d:%d", &opcode, &starting, &amount) != 3)
1508 return -EBADRQC;
1509
1510 drop_current_cnt = 0;
1511 drop_fabric_opcode = (opcode & ~DROP_OPCODE_MASK) ? true : false;
1512 drop_opcode = (opcode & DROP_OPCODE_MASK);
1513 drop_instance = starting;
1514 /* the check to drop routine uses instance + count to know when
1515 * to end. Thus, if dropping 1 instance, count should be 0.
1516 * so subtract 1 from the count.
1517 */
1518 drop_amount = amount - 1;
1519
1520 pr_info("%s: DROP: Starting at instance %d of%s opcode x%x drop +%d "
1521 "instances\n",
1522 __func__, drop_instance, drop_fabric_opcode ? " fabric" : "",
1523 drop_opcode, drop_amount);
1524
1525 return count;
1526 }
1527
1528
1529 static DEVICE_ATTR(add_local_port, 0200, NULL, fcloop_create_local_port);
1530 static DEVICE_ATTR(del_local_port, 0200, NULL, fcloop_delete_local_port);
1531 static DEVICE_ATTR(add_remote_port, 0200, NULL, fcloop_create_remote_port);
1532 static DEVICE_ATTR(del_remote_port, 0200, NULL, fcloop_delete_remote_port);
1533 static DEVICE_ATTR(add_target_port, 0200, NULL, fcloop_create_target_port);
1534 static DEVICE_ATTR(del_target_port, 0200, NULL, fcloop_delete_target_port);
1535 static DEVICE_ATTR(set_cmd_drop, 0200, NULL, fcloop_set_cmd_drop);
1536
1537 static struct attribute *fcloop_dev_attrs[] = {
1538 &dev_attr_add_local_port.attr,
1539 &dev_attr_del_local_port.attr,
1540 &dev_attr_add_remote_port.attr,
1541 &dev_attr_del_remote_port.attr,
1542 &dev_attr_add_target_port.attr,
1543 &dev_attr_del_target_port.attr,
1544 &dev_attr_set_cmd_drop.attr,
1545 NULL
1546 };
1547
1548 static const struct attribute_group fclopp_dev_attrs_group = {
1549 .attrs = fcloop_dev_attrs,
1550 };
1551
1552 static const struct attribute_group *fcloop_dev_attr_groups[] = {
1553 &fclopp_dev_attrs_group,
1554 NULL,
1555 };
1556
1557 static struct class *fcloop_class;
1558 static struct device *fcloop_device;
1559
1560
fcloop_init(void)1561 static int __init fcloop_init(void)
1562 {
1563 int ret;
1564
1565 fcloop_class = class_create(THIS_MODULE, "fcloop");
1566 if (IS_ERR(fcloop_class)) {
1567 pr_err("couldn't register class fcloop\n");
1568 ret = PTR_ERR(fcloop_class);
1569 return ret;
1570 }
1571
1572 fcloop_device = device_create_with_groups(
1573 fcloop_class, NULL, MKDEV(0, 0), NULL,
1574 fcloop_dev_attr_groups, "ctl");
1575 if (IS_ERR(fcloop_device)) {
1576 pr_err("couldn't create ctl device!\n");
1577 ret = PTR_ERR(fcloop_device);
1578 goto out_destroy_class;
1579 }
1580
1581 get_device(fcloop_device);
1582
1583 return 0;
1584
1585 out_destroy_class:
1586 class_destroy(fcloop_class);
1587 return ret;
1588 }
1589
fcloop_exit(void)1590 static void __exit fcloop_exit(void)
1591 {
1592 struct fcloop_lport *lport = NULL;
1593 struct fcloop_nport *nport = NULL;
1594 struct fcloop_tport *tport;
1595 struct fcloop_rport *rport;
1596 unsigned long flags;
1597 int ret;
1598
1599 spin_lock_irqsave(&fcloop_lock, flags);
1600
1601 for (;;) {
1602 nport = list_first_entry_or_null(&fcloop_nports,
1603 typeof(*nport), nport_list);
1604 if (!nport)
1605 break;
1606
1607 tport = __unlink_target_port(nport);
1608 rport = __unlink_remote_port(nport);
1609
1610 spin_unlock_irqrestore(&fcloop_lock, flags);
1611
1612 ret = __targetport_unreg(nport, tport);
1613 if (ret)
1614 pr_warn("%s: Failed deleting target port\n", __func__);
1615
1616 ret = __remoteport_unreg(nport, rport);
1617 if (ret)
1618 pr_warn("%s: Failed deleting remote port\n", __func__);
1619
1620 spin_lock_irqsave(&fcloop_lock, flags);
1621 }
1622
1623 for (;;) {
1624 lport = list_first_entry_or_null(&fcloop_lports,
1625 typeof(*lport), lport_list);
1626 if (!lport)
1627 break;
1628
1629 __unlink_local_port(lport);
1630
1631 spin_unlock_irqrestore(&fcloop_lock, flags);
1632
1633 ret = __wait_localport_unreg(lport);
1634 if (ret)
1635 pr_warn("%s: Failed deleting local port\n", __func__);
1636
1637 spin_lock_irqsave(&fcloop_lock, flags);
1638 }
1639
1640 spin_unlock_irqrestore(&fcloop_lock, flags);
1641
1642 put_device(fcloop_device);
1643
1644 device_destroy(fcloop_class, MKDEV(0, 0));
1645 class_destroy(fcloop_class);
1646 }
1647
1648 module_init(fcloop_init);
1649 module_exit(fcloop_exit);
1650
1651 MODULE_LICENSE("GPL v2");
1652