xref: /openbmc/linux/drivers/block/rnbd/rnbd-clt.c (revision 54a611b6)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * RDMA Network Block Driver
4  *
5  * Copyright (c) 2014 - 2018 ProfitBricks GmbH. All rights reserved.
6  * Copyright (c) 2018 - 2019 1&1 IONOS Cloud GmbH. All rights reserved.
7  * Copyright (c) 2019 - 2020 1&1 IONOS SE. All rights reserved.
8  */
9 
10 #undef pr_fmt
11 #define pr_fmt(fmt) KBUILD_MODNAME " L" __stringify(__LINE__) ": " fmt
12 
13 #include <linux/module.h>
14 #include <linux/blkdev.h>
15 #include <linux/hdreg.h>
16 #include <linux/scatterlist.h>
17 #include <linux/idr.h>
18 
19 #include "rnbd-clt.h"
20 
21 MODULE_DESCRIPTION("RDMA Network Block Device Client");
22 MODULE_LICENSE("GPL");
23 
24 static int rnbd_client_major;
25 static DEFINE_IDA(index_ida);
26 static DEFINE_MUTEX(sess_lock);
27 static LIST_HEAD(sess_list);
28 static struct workqueue_struct *rnbd_clt_wq;
29 
30 /*
31  * Maximum number of partitions an instance can have.
32  * 6 bits = 64 minors = 63 partitions (one minor is used for the device itself)
33  */
34 #define RNBD_PART_BITS		6
35 
36 static inline bool rnbd_clt_get_sess(struct rnbd_clt_session *sess)
37 {
38 	return refcount_inc_not_zero(&sess->refcount);
39 }
40 
41 static void free_sess(struct rnbd_clt_session *sess);
42 
43 static void rnbd_clt_put_sess(struct rnbd_clt_session *sess)
44 {
45 	might_sleep();
46 
47 	if (refcount_dec_and_test(&sess->refcount))
48 		free_sess(sess);
49 }
50 
51 static void rnbd_clt_put_dev(struct rnbd_clt_dev *dev)
52 {
53 	might_sleep();
54 
55 	if (!refcount_dec_and_test(&dev->refcount))
56 		return;
57 
58 	ida_free(&index_ida, dev->clt_device_id);
59 	kfree(dev->hw_queues);
60 	kfree(dev->pathname);
61 	rnbd_clt_put_sess(dev->sess);
62 	mutex_destroy(&dev->lock);
63 	kfree(dev);
64 }
65 
66 static inline bool rnbd_clt_get_dev(struct rnbd_clt_dev *dev)
67 {
68 	return refcount_inc_not_zero(&dev->refcount);
69 }
70 
71 static void rnbd_clt_change_capacity(struct rnbd_clt_dev *dev,
72 				    sector_t new_nsectors)
73 {
74 	if (get_capacity(dev->gd) == new_nsectors)
75 		return;
76 
77 	/*
78 	 * If the size changed, we need to revalidate it
79 	 */
80 	rnbd_clt_info(dev, "Device size changed from %llu to %llu sectors\n",
81 		      get_capacity(dev->gd), new_nsectors);
82 	set_capacity_and_notify(dev->gd, new_nsectors);
83 }
84 
85 static int process_msg_open_rsp(struct rnbd_clt_dev *dev,
86 				struct rnbd_msg_open_rsp *rsp)
87 {
88 	struct kobject *gd_kobj;
89 	int err = 0;
90 
91 	mutex_lock(&dev->lock);
92 	if (dev->dev_state == DEV_STATE_UNMAPPED) {
93 		rnbd_clt_info(dev,
94 			       "Ignoring Open-Response message from server for  unmapped device\n");
95 		err = -ENOENT;
96 		goto out;
97 	}
98 	if (dev->dev_state == DEV_STATE_MAPPED_DISCONNECTED) {
99 		u64 nsectors = le64_to_cpu(rsp->nsectors);
100 
101 		rnbd_clt_change_capacity(dev, nsectors);
102 		gd_kobj = &disk_to_dev(dev->gd)->kobj;
103 		kobject_uevent(gd_kobj, KOBJ_ONLINE);
104 		rnbd_clt_info(dev, "Device online, device remapped successfully\n");
105 	}
106 	if (!rsp->logical_block_size) {
107 		err = -EINVAL;
108 		goto out;
109 	}
110 	dev->device_id = le32_to_cpu(rsp->device_id);
111 	dev->dev_state = DEV_STATE_MAPPED;
112 
113 out:
114 	mutex_unlock(&dev->lock);
115 
116 	return err;
117 }
118 
119 int rnbd_clt_resize_disk(struct rnbd_clt_dev *dev, sector_t newsize)
120 {
121 	int ret = 0;
122 
123 	mutex_lock(&dev->lock);
124 	if (dev->dev_state != DEV_STATE_MAPPED) {
125 		pr_err("Failed to set new size of the device, device is not opened\n");
126 		ret = -ENOENT;
127 		goto out;
128 	}
129 	rnbd_clt_change_capacity(dev, newsize);
130 
131 out:
132 	mutex_unlock(&dev->lock);
133 
134 	return ret;
135 }
136 
137 static inline void rnbd_clt_dev_requeue(struct rnbd_queue *q)
138 {
139 	if (WARN_ON(!q->hctx))
140 		return;
141 
142 	/* We can come here from interrupt, thus async=true */
143 	blk_mq_run_hw_queue(q->hctx, true);
144 }
145 
146 enum {
147 	RNBD_DELAY_IFBUSY = -1,
148 };
149 
150 /**
151  * rnbd_get_cpu_qlist() - finds a list with HW queues to be rerun
152  * @sess:	Session to find a queue for
153  * @cpu:	Cpu to start the search from
154  *
155  * Description:
156  *     Each CPU has a list of HW queues, which needs to be rerun.  If a list
157  *     is not empty - it is marked with a bit.  This function finds first
158  *     set bit in a bitmap and returns corresponding CPU list.
159  */
160 static struct rnbd_cpu_qlist *
161 rnbd_get_cpu_qlist(struct rnbd_clt_session *sess, int cpu)
162 {
163 	int bit;
164 
165 	/* Search from cpu to nr_cpu_ids */
166 	bit = find_next_bit(sess->cpu_queues_bm, nr_cpu_ids, cpu);
167 	if (bit < nr_cpu_ids) {
168 		return per_cpu_ptr(sess->cpu_queues, bit);
169 	} else if (cpu != 0) {
170 		/* Search from 0 to cpu */
171 		bit = find_first_bit(sess->cpu_queues_bm, cpu);
172 		if (bit < cpu)
173 			return per_cpu_ptr(sess->cpu_queues, bit);
174 	}
175 
176 	return NULL;
177 }
178 
179 static inline int nxt_cpu(int cpu)
180 {
181 	return (cpu + 1) % nr_cpu_ids;
182 }
183 
184 /**
185  * rnbd_rerun_if_needed() - rerun next queue marked as stopped
186  * @sess:	Session to rerun a queue on
187  *
188  * Description:
189  *     Each CPU has it's own list of HW queues, which should be rerun.
190  *     Function finds such list with HW queues, takes a list lock, picks up
191  *     the first HW queue out of the list and requeues it.
192  *
193  * Return:
194  *     True if the queue was requeued, false otherwise.
195  *
196  * Context:
197  *     Does not matter.
198  */
199 static bool rnbd_rerun_if_needed(struct rnbd_clt_session *sess)
200 {
201 	struct rnbd_queue *q = NULL;
202 	struct rnbd_cpu_qlist *cpu_q;
203 	unsigned long flags;
204 	int *cpup;
205 
206 	/*
207 	 * To keep fairness and not to let other queues starve we always
208 	 * try to wake up someone else in round-robin manner.  That of course
209 	 * increases latency but queues always have a chance to be executed.
210 	 */
211 	cpup = get_cpu_ptr(sess->cpu_rr);
212 	for (cpu_q = rnbd_get_cpu_qlist(sess, nxt_cpu(*cpup)); cpu_q;
213 	     cpu_q = rnbd_get_cpu_qlist(sess, nxt_cpu(cpu_q->cpu))) {
214 		if (!spin_trylock_irqsave(&cpu_q->requeue_lock, flags))
215 			continue;
216 		if (!test_bit(cpu_q->cpu, sess->cpu_queues_bm))
217 			goto unlock;
218 		q = list_first_entry_or_null(&cpu_q->requeue_list,
219 					     typeof(*q), requeue_list);
220 		if (WARN_ON(!q))
221 			goto clear_bit;
222 		list_del_init(&q->requeue_list);
223 		clear_bit_unlock(0, &q->in_list);
224 
225 		if (list_empty(&cpu_q->requeue_list)) {
226 			/* Clear bit if nothing is left */
227 clear_bit:
228 			clear_bit(cpu_q->cpu, sess->cpu_queues_bm);
229 		}
230 unlock:
231 		spin_unlock_irqrestore(&cpu_q->requeue_lock, flags);
232 
233 		if (q)
234 			break;
235 	}
236 
237 	/**
238 	 * Saves the CPU that is going to be requeued on the per-cpu var. Just
239 	 * incrementing it doesn't work because rnbd_get_cpu_qlist() will
240 	 * always return the first CPU with something on the queue list when the
241 	 * value stored on the var is greater than the last CPU with something
242 	 * on the list.
243 	 */
244 	if (cpu_q)
245 		*cpup = cpu_q->cpu;
246 	put_cpu_ptr(sess->cpu_rr);
247 
248 	if (q)
249 		rnbd_clt_dev_requeue(q);
250 
251 	return q;
252 }
253 
254 /**
255  * rnbd_rerun_all_if_idle() - rerun all queues left in the list if
256  *				 session is idling (there are no requests
257  *				 in-flight).
258  * @sess:	Session to rerun the queues on
259  *
260  * Description:
261  *     This function tries to rerun all stopped queues if there are no
262  *     requests in-flight anymore.  This function tries to solve an obvious
263  *     problem, when number of tags < than number of queues (hctx), which
264  *     are stopped and put to sleep.  If last permit, which has been just put,
265  *     does not wake up all left queues (hctxs), IO requests hang forever.
266  *
267  *     That can happen when all number of permits, say N, have been exhausted
268  *     from one CPU, and we have many block devices per session, say M.
269  *     Each block device has it's own queue (hctx) for each CPU, so eventually
270  *     we can put that number of queues (hctxs) to sleep: M x nr_cpu_ids.
271  *     If number of permits N < M x nr_cpu_ids finally we will get an IO hang.
272  *
273  *     To avoid this hang last caller of rnbd_put_permit() (last caller is the
274  *     one who observes sess->busy == 0) must wake up all remaining queues.
275  *
276  * Context:
277  *     Does not matter.
278  */
279 static void rnbd_rerun_all_if_idle(struct rnbd_clt_session *sess)
280 {
281 	bool requeued;
282 
283 	do {
284 		requeued = rnbd_rerun_if_needed(sess);
285 	} while (atomic_read(&sess->busy) == 0 && requeued);
286 }
287 
288 static struct rtrs_permit *rnbd_get_permit(struct rnbd_clt_session *sess,
289 					     enum rtrs_clt_con_type con_type,
290 					     enum wait_type wait)
291 {
292 	struct rtrs_permit *permit;
293 
294 	permit = rtrs_clt_get_permit(sess->rtrs, con_type, wait);
295 	if (permit)
296 		/* We have a subtle rare case here, when all permits can be
297 		 * consumed before busy counter increased.  This is safe,
298 		 * because loser will get NULL as a permit, observe 0 busy
299 		 * counter and immediately restart the queue himself.
300 		 */
301 		atomic_inc(&sess->busy);
302 
303 	return permit;
304 }
305 
306 static void rnbd_put_permit(struct rnbd_clt_session *sess,
307 			     struct rtrs_permit *permit)
308 {
309 	rtrs_clt_put_permit(sess->rtrs, permit);
310 	atomic_dec(&sess->busy);
311 	/* Paired with rnbd_clt_dev_add_to_requeue().  Decrement first
312 	 * and then check queue bits.
313 	 */
314 	smp_mb__after_atomic();
315 	rnbd_rerun_all_if_idle(sess);
316 }
317 
318 static struct rnbd_iu *rnbd_get_iu(struct rnbd_clt_session *sess,
319 				     enum rtrs_clt_con_type con_type,
320 				     enum wait_type wait)
321 {
322 	struct rnbd_iu *iu;
323 	struct rtrs_permit *permit;
324 
325 	iu = kzalloc(sizeof(*iu), GFP_KERNEL);
326 	if (!iu)
327 		return NULL;
328 
329 	permit = rnbd_get_permit(sess, con_type, wait);
330 	if (!permit) {
331 		kfree(iu);
332 		return NULL;
333 	}
334 
335 	iu->permit = permit;
336 	/*
337 	 * 1st reference is dropped after finishing sending a "user" message,
338 	 * 2nd reference is dropped after confirmation with the response is
339 	 * returned.
340 	 * 1st and 2nd can happen in any order, so the rnbd_iu should be
341 	 * released (rtrs_permit returned to rtrs) only after both
342 	 * are finished.
343 	 */
344 	atomic_set(&iu->refcount, 2);
345 	init_waitqueue_head(&iu->comp.wait);
346 	iu->comp.errno = INT_MAX;
347 
348 	if (sg_alloc_table(&iu->sgt, 1, GFP_KERNEL)) {
349 		rnbd_put_permit(sess, permit);
350 		kfree(iu);
351 		return NULL;
352 	}
353 
354 	return iu;
355 }
356 
357 static void rnbd_put_iu(struct rnbd_clt_session *sess, struct rnbd_iu *iu)
358 {
359 	if (atomic_dec_and_test(&iu->refcount)) {
360 		sg_free_table(&iu->sgt);
361 		rnbd_put_permit(sess, iu->permit);
362 		kfree(iu);
363 	}
364 }
365 
366 static void rnbd_softirq_done_fn(struct request *rq)
367 {
368 	struct rnbd_clt_dev *dev	= rq->q->disk->private_data;
369 	struct rnbd_clt_session *sess	= dev->sess;
370 	struct rnbd_iu *iu;
371 
372 	iu = blk_mq_rq_to_pdu(rq);
373 	sg_free_table_chained(&iu->sgt, RNBD_INLINE_SG_CNT);
374 	rnbd_put_permit(sess, iu->permit);
375 	blk_mq_end_request(rq, errno_to_blk_status(iu->errno));
376 }
377 
378 static void msg_io_conf(void *priv, int errno)
379 {
380 	struct rnbd_iu *iu = priv;
381 	struct rnbd_clt_dev *dev = iu->dev;
382 	struct request *rq = iu->rq;
383 	int rw = rq_data_dir(rq);
384 
385 	iu->errno = errno;
386 
387 	blk_mq_complete_request(rq);
388 
389 	if (errno)
390 		rnbd_clt_info_rl(dev, "%s I/O failed with err: %d\n",
391 				 rw == READ ? "read" : "write", errno);
392 }
393 
394 static void wake_up_iu_comp(struct rnbd_iu *iu, int errno)
395 {
396 	iu->comp.errno = errno;
397 	wake_up(&iu->comp.wait);
398 }
399 
400 static void msg_conf(void *priv, int errno)
401 {
402 	struct rnbd_iu *iu = priv;
403 
404 	iu->errno = errno;
405 	schedule_work(&iu->work);
406 }
407 
408 static int send_usr_msg(struct rtrs_clt_sess *rtrs, int dir,
409 			struct rnbd_iu *iu, struct kvec *vec,
410 			size_t len, struct scatterlist *sg, unsigned int sg_len,
411 			void (*conf)(struct work_struct *work),
412 			int *errno, int wait)
413 {
414 	int err;
415 	struct rtrs_clt_req_ops req_ops;
416 
417 	INIT_WORK(&iu->work, conf);
418 	req_ops = (struct rtrs_clt_req_ops) {
419 		.priv = iu,
420 		.conf_fn = msg_conf,
421 	};
422 	err = rtrs_clt_request(dir, &req_ops, rtrs, iu->permit,
423 				vec, 1, len, sg, sg_len);
424 	if (!err && wait) {
425 		wait_event(iu->comp.wait, iu->comp.errno != INT_MAX);
426 		*errno = iu->comp.errno;
427 	} else {
428 		*errno = 0;
429 	}
430 
431 	return err;
432 }
433 
434 static void msg_close_conf(struct work_struct *work)
435 {
436 	struct rnbd_iu *iu = container_of(work, struct rnbd_iu, work);
437 	struct rnbd_clt_dev *dev = iu->dev;
438 
439 	wake_up_iu_comp(iu, iu->errno);
440 	rnbd_put_iu(dev->sess, iu);
441 	rnbd_clt_put_dev(dev);
442 }
443 
444 static int send_msg_close(struct rnbd_clt_dev *dev, u32 device_id,
445 			  enum wait_type wait)
446 {
447 	struct rnbd_clt_session *sess = dev->sess;
448 	struct rnbd_msg_close msg;
449 	struct rnbd_iu *iu;
450 	struct kvec vec = {
451 		.iov_base = &msg,
452 		.iov_len  = sizeof(msg)
453 	};
454 	int err, errno;
455 
456 	iu = rnbd_get_iu(sess, RTRS_ADMIN_CON, RTRS_PERMIT_WAIT);
457 	if (!iu)
458 		return -ENOMEM;
459 
460 	iu->buf = NULL;
461 	iu->dev = dev;
462 
463 	msg.hdr.type	= cpu_to_le16(RNBD_MSG_CLOSE);
464 	msg.device_id	= cpu_to_le32(device_id);
465 
466 	WARN_ON(!rnbd_clt_get_dev(dev));
467 	err = send_usr_msg(sess->rtrs, WRITE, iu, &vec, 0, NULL, 0,
468 			   msg_close_conf, &errno, wait);
469 	if (err) {
470 		rnbd_clt_put_dev(dev);
471 		rnbd_put_iu(sess, iu);
472 	} else {
473 		err = errno;
474 	}
475 
476 	rnbd_put_iu(sess, iu);
477 	return err;
478 }
479 
480 static void msg_open_conf(struct work_struct *work)
481 {
482 	struct rnbd_iu *iu = container_of(work, struct rnbd_iu, work);
483 	struct rnbd_msg_open_rsp *rsp = iu->buf;
484 	struct rnbd_clt_dev *dev = iu->dev;
485 	int errno = iu->errno;
486 	bool from_map = false;
487 
488 	/* INIT state is only triggered from rnbd_clt_map_device */
489 	if (dev->dev_state == DEV_STATE_INIT)
490 		from_map = true;
491 
492 	if (errno) {
493 		rnbd_clt_err(dev,
494 			      "Opening failed, server responded: %d\n",
495 			      errno);
496 	} else {
497 		errno = process_msg_open_rsp(dev, rsp);
498 		if (errno) {
499 			u32 device_id = le32_to_cpu(rsp->device_id);
500 			/*
501 			 * If server thinks its fine, but we fail to process
502 			 * then be nice and send a close to server.
503 			 */
504 			send_msg_close(dev, device_id, RTRS_PERMIT_NOWAIT);
505 		}
506 	}
507 	/* We free rsp in rnbd_clt_map_device for map scenario */
508 	if (!from_map)
509 		kfree(rsp);
510 	wake_up_iu_comp(iu, errno);
511 	rnbd_put_iu(dev->sess, iu);
512 	rnbd_clt_put_dev(dev);
513 }
514 
515 static void msg_sess_info_conf(struct work_struct *work)
516 {
517 	struct rnbd_iu *iu = container_of(work, struct rnbd_iu, work);
518 	struct rnbd_msg_sess_info_rsp *rsp = iu->buf;
519 	struct rnbd_clt_session *sess = iu->sess;
520 
521 	if (!iu->errno)
522 		sess->ver = min_t(u8, rsp->ver, RNBD_PROTO_VER_MAJOR);
523 
524 	kfree(rsp);
525 	wake_up_iu_comp(iu, iu->errno);
526 	rnbd_put_iu(sess, iu);
527 	rnbd_clt_put_sess(sess);
528 }
529 
530 static int send_msg_open(struct rnbd_clt_dev *dev, enum wait_type wait)
531 {
532 	struct rnbd_clt_session *sess = dev->sess;
533 	struct rnbd_msg_open_rsp *rsp;
534 	struct rnbd_msg_open msg;
535 	struct rnbd_iu *iu;
536 	struct kvec vec = {
537 		.iov_base = &msg,
538 		.iov_len  = sizeof(msg)
539 	};
540 	int err, errno;
541 
542 	rsp = kzalloc(sizeof(*rsp), GFP_KERNEL);
543 	if (!rsp)
544 		return -ENOMEM;
545 
546 	iu = rnbd_get_iu(sess, RTRS_ADMIN_CON, RTRS_PERMIT_WAIT);
547 	if (!iu) {
548 		kfree(rsp);
549 		return -ENOMEM;
550 	}
551 
552 	iu->buf = rsp;
553 	iu->dev = dev;
554 
555 	sg_init_one(iu->sgt.sgl, rsp, sizeof(*rsp));
556 
557 	msg.hdr.type	= cpu_to_le16(RNBD_MSG_OPEN);
558 	msg.access_mode	= dev->access_mode;
559 	strscpy(msg.dev_name, dev->pathname, sizeof(msg.dev_name));
560 
561 	WARN_ON(!rnbd_clt_get_dev(dev));
562 	err = send_usr_msg(sess->rtrs, READ, iu,
563 			   &vec, sizeof(*rsp), iu->sgt.sgl, 1,
564 			   msg_open_conf, &errno, wait);
565 	if (err) {
566 		rnbd_clt_put_dev(dev);
567 		rnbd_put_iu(sess, iu);
568 		kfree(rsp);
569 	} else {
570 		err = errno;
571 	}
572 
573 	rnbd_put_iu(sess, iu);
574 	return err;
575 }
576 
577 static int send_msg_sess_info(struct rnbd_clt_session *sess, enum wait_type wait)
578 {
579 	struct rnbd_msg_sess_info_rsp *rsp;
580 	struct rnbd_msg_sess_info msg;
581 	struct rnbd_iu *iu;
582 	struct kvec vec = {
583 		.iov_base = &msg,
584 		.iov_len  = sizeof(msg)
585 	};
586 	int err, errno;
587 
588 	rsp = kzalloc(sizeof(*rsp), GFP_KERNEL);
589 	if (!rsp)
590 		return -ENOMEM;
591 
592 	iu = rnbd_get_iu(sess, RTRS_ADMIN_CON, RTRS_PERMIT_WAIT);
593 	if (!iu) {
594 		kfree(rsp);
595 		return -ENOMEM;
596 	}
597 
598 	iu->buf = rsp;
599 	iu->sess = sess;
600 	sg_init_one(iu->sgt.sgl, rsp, sizeof(*rsp));
601 
602 	msg.hdr.type = cpu_to_le16(RNBD_MSG_SESS_INFO);
603 	msg.ver      = RNBD_PROTO_VER_MAJOR;
604 
605 	if (!rnbd_clt_get_sess(sess)) {
606 		/*
607 		 * That can happen only in one case, when RTRS has restablished
608 		 * the connection and link_ev() is called, but session is almost
609 		 * dead, last reference on session is put and caller is waiting
610 		 * for RTRS to close everything.
611 		 */
612 		err = -ENODEV;
613 		goto put_iu;
614 	}
615 	err = send_usr_msg(sess->rtrs, READ, iu,
616 			   &vec, sizeof(*rsp), iu->sgt.sgl, 1,
617 			   msg_sess_info_conf, &errno, wait);
618 	if (err) {
619 		rnbd_clt_put_sess(sess);
620 put_iu:
621 		rnbd_put_iu(sess, iu);
622 		kfree(rsp);
623 	} else {
624 		err = errno;
625 	}
626 	rnbd_put_iu(sess, iu);
627 	return err;
628 }
629 
630 static void set_dev_states_to_disconnected(struct rnbd_clt_session *sess)
631 {
632 	struct rnbd_clt_dev *dev;
633 	struct kobject *gd_kobj;
634 
635 	mutex_lock(&sess->lock);
636 	list_for_each_entry(dev, &sess->devs_list, list) {
637 		rnbd_clt_err(dev, "Device disconnected.\n");
638 
639 		mutex_lock(&dev->lock);
640 		if (dev->dev_state == DEV_STATE_MAPPED) {
641 			dev->dev_state = DEV_STATE_MAPPED_DISCONNECTED;
642 			gd_kobj = &disk_to_dev(dev->gd)->kobj;
643 			kobject_uevent(gd_kobj, KOBJ_OFFLINE);
644 		}
645 		mutex_unlock(&dev->lock);
646 	}
647 	mutex_unlock(&sess->lock);
648 }
649 
650 static void remap_devs(struct rnbd_clt_session *sess)
651 {
652 	struct rnbd_clt_dev *dev;
653 	struct rtrs_attrs attrs;
654 	int err;
655 
656 	/*
657 	 * Careful here: we are called from RTRS link event directly,
658 	 * thus we can't send any RTRS request and wait for response
659 	 * or RTRS will not be able to complete request with failure
660 	 * if something goes wrong (failing of outstanding requests
661 	 * happens exactly from the context where we are blocking now).
662 	 *
663 	 * So to avoid deadlocks each usr message sent from here must
664 	 * be asynchronous.
665 	 */
666 
667 	err = send_msg_sess_info(sess, RTRS_PERMIT_NOWAIT);
668 	if (err) {
669 		pr_err("send_msg_sess_info(\"%s\"): %d\n", sess->sessname, err);
670 		return;
671 	}
672 
673 	err = rtrs_clt_query(sess->rtrs, &attrs);
674 	if (err) {
675 		pr_err("rtrs_clt_query(\"%s\"): %d\n", sess->sessname, err);
676 		return;
677 	}
678 	mutex_lock(&sess->lock);
679 	sess->max_io_size = attrs.max_io_size;
680 
681 	list_for_each_entry(dev, &sess->devs_list, list) {
682 		bool skip;
683 
684 		mutex_lock(&dev->lock);
685 		skip = (dev->dev_state == DEV_STATE_INIT);
686 		mutex_unlock(&dev->lock);
687 		if (skip)
688 			/*
689 			 * When device is establishing connection for the first
690 			 * time - do not remap, it will be closed soon.
691 			 */
692 			continue;
693 
694 		rnbd_clt_info(dev, "session reconnected, remapping device\n");
695 		err = send_msg_open(dev, RTRS_PERMIT_NOWAIT);
696 		if (err) {
697 			rnbd_clt_err(dev, "send_msg_open(): %d\n", err);
698 			break;
699 		}
700 	}
701 	mutex_unlock(&sess->lock);
702 }
703 
704 static void rnbd_clt_link_ev(void *priv, enum rtrs_clt_link_ev ev)
705 {
706 	struct rnbd_clt_session *sess = priv;
707 
708 	switch (ev) {
709 	case RTRS_CLT_LINK_EV_DISCONNECTED:
710 		set_dev_states_to_disconnected(sess);
711 		break;
712 	case RTRS_CLT_LINK_EV_RECONNECTED:
713 		remap_devs(sess);
714 		break;
715 	default:
716 		pr_err("Unknown session event received (%d), session: %s\n",
717 		       ev, sess->sessname);
718 	}
719 }
720 
721 static void rnbd_init_cpu_qlists(struct rnbd_cpu_qlist __percpu *cpu_queues)
722 {
723 	unsigned int cpu;
724 	struct rnbd_cpu_qlist *cpu_q;
725 
726 	for_each_possible_cpu(cpu) {
727 		cpu_q = per_cpu_ptr(cpu_queues, cpu);
728 
729 		cpu_q->cpu = cpu;
730 		INIT_LIST_HEAD(&cpu_q->requeue_list);
731 		spin_lock_init(&cpu_q->requeue_lock);
732 	}
733 }
734 
735 static void destroy_mq_tags(struct rnbd_clt_session *sess)
736 {
737 	if (sess->tag_set.tags)
738 		blk_mq_free_tag_set(&sess->tag_set);
739 }
740 
741 static inline void wake_up_rtrs_waiters(struct rnbd_clt_session *sess)
742 {
743 	sess->rtrs_ready = true;
744 	wake_up_all(&sess->rtrs_waitq);
745 }
746 
747 static void close_rtrs(struct rnbd_clt_session *sess)
748 {
749 	might_sleep();
750 
751 	if (!IS_ERR_OR_NULL(sess->rtrs)) {
752 		rtrs_clt_close(sess->rtrs);
753 		sess->rtrs = NULL;
754 		wake_up_rtrs_waiters(sess);
755 	}
756 }
757 
758 static void free_sess(struct rnbd_clt_session *sess)
759 {
760 	WARN_ON(!list_empty(&sess->devs_list));
761 
762 	might_sleep();
763 
764 	close_rtrs(sess);
765 	destroy_mq_tags(sess);
766 	if (!list_empty(&sess->list)) {
767 		mutex_lock(&sess_lock);
768 		list_del(&sess->list);
769 		mutex_unlock(&sess_lock);
770 	}
771 	free_percpu(sess->cpu_queues);
772 	free_percpu(sess->cpu_rr);
773 	mutex_destroy(&sess->lock);
774 	kfree(sess);
775 }
776 
777 static struct rnbd_clt_session *alloc_sess(const char *sessname)
778 {
779 	struct rnbd_clt_session *sess;
780 	int err, cpu;
781 
782 	sess = kzalloc_node(sizeof(*sess), GFP_KERNEL, NUMA_NO_NODE);
783 	if (!sess)
784 		return ERR_PTR(-ENOMEM);
785 	strscpy(sess->sessname, sessname, sizeof(sess->sessname));
786 	atomic_set(&sess->busy, 0);
787 	mutex_init(&sess->lock);
788 	INIT_LIST_HEAD(&sess->devs_list);
789 	INIT_LIST_HEAD(&sess->list);
790 	bitmap_zero(sess->cpu_queues_bm, num_possible_cpus());
791 	init_waitqueue_head(&sess->rtrs_waitq);
792 	refcount_set(&sess->refcount, 1);
793 
794 	sess->cpu_queues = alloc_percpu(struct rnbd_cpu_qlist);
795 	if (!sess->cpu_queues) {
796 		err = -ENOMEM;
797 		goto err;
798 	}
799 	rnbd_init_cpu_qlists(sess->cpu_queues);
800 
801 	/*
802 	 * That is simple percpu variable which stores cpu indices, which are
803 	 * incremented on each access.  We need that for the sake of fairness
804 	 * to wake up queues in a round-robin manner.
805 	 */
806 	sess->cpu_rr = alloc_percpu(int);
807 	if (!sess->cpu_rr) {
808 		err = -ENOMEM;
809 		goto err;
810 	}
811 	for_each_possible_cpu(cpu)
812 		* per_cpu_ptr(sess->cpu_rr, cpu) = cpu;
813 
814 	return sess;
815 
816 err:
817 	free_sess(sess);
818 
819 	return ERR_PTR(err);
820 }
821 
822 static int wait_for_rtrs_connection(struct rnbd_clt_session *sess)
823 {
824 	wait_event(sess->rtrs_waitq, sess->rtrs_ready);
825 	if (IS_ERR_OR_NULL(sess->rtrs))
826 		return -ECONNRESET;
827 
828 	return 0;
829 }
830 
831 static void wait_for_rtrs_disconnection(struct rnbd_clt_session *sess)
832 	__releases(&sess_lock)
833 	__acquires(&sess_lock)
834 {
835 	DEFINE_WAIT(wait);
836 
837 	prepare_to_wait(&sess->rtrs_waitq, &wait, TASK_UNINTERRUPTIBLE);
838 	if (IS_ERR_OR_NULL(sess->rtrs)) {
839 		finish_wait(&sess->rtrs_waitq, &wait);
840 		return;
841 	}
842 	mutex_unlock(&sess_lock);
843 	/* loop in caller, see __find_and_get_sess().
844 	 * You can't leave mutex locked and call schedule(), you will catch a
845 	 * deadlock with a caller of free_sess(), which has just put the last
846 	 * reference and is about to take the sess_lock in order to delete
847 	 * the session from the list.
848 	 */
849 	schedule();
850 	mutex_lock(&sess_lock);
851 }
852 
853 static struct rnbd_clt_session *__find_and_get_sess(const char *sessname)
854 	__releases(&sess_lock)
855 	__acquires(&sess_lock)
856 {
857 	struct rnbd_clt_session *sess, *sn;
858 	int err;
859 
860 again:
861 	list_for_each_entry_safe(sess, sn, &sess_list, list) {
862 		if (strcmp(sessname, sess->sessname))
863 			continue;
864 
865 		if (sess->rtrs_ready && IS_ERR_OR_NULL(sess->rtrs))
866 			/*
867 			 * No RTRS connection, session is dying.
868 			 */
869 			continue;
870 
871 		if (rnbd_clt_get_sess(sess)) {
872 			/*
873 			 * Alive session is found, wait for RTRS connection.
874 			 */
875 			mutex_unlock(&sess_lock);
876 			err = wait_for_rtrs_connection(sess);
877 			if (err)
878 				rnbd_clt_put_sess(sess);
879 			mutex_lock(&sess_lock);
880 
881 			if (err)
882 				/* Session is dying, repeat the loop */
883 				goto again;
884 
885 			return sess;
886 		}
887 		/*
888 		 * Ref is 0, session is dying, wait for RTRS disconnect
889 		 * in order to avoid session names clashes.
890 		 */
891 		wait_for_rtrs_disconnection(sess);
892 		/*
893 		 * RTRS is disconnected and soon session will be freed,
894 		 * so repeat a loop.
895 		 */
896 		goto again;
897 	}
898 
899 	return NULL;
900 }
901 
902 /* caller is responsible for initializing 'first' to false */
903 static struct
904 rnbd_clt_session *find_or_create_sess(const char *sessname, bool *first)
905 {
906 	struct rnbd_clt_session *sess = NULL;
907 
908 	mutex_lock(&sess_lock);
909 	sess = __find_and_get_sess(sessname);
910 	if (!sess) {
911 		sess = alloc_sess(sessname);
912 		if (IS_ERR(sess)) {
913 			mutex_unlock(&sess_lock);
914 			return sess;
915 		}
916 		list_add(&sess->list, &sess_list);
917 		*first = true;
918 	}
919 	mutex_unlock(&sess_lock);
920 
921 	return sess;
922 }
923 
924 static int rnbd_client_open(struct block_device *block_device, fmode_t mode)
925 {
926 	struct rnbd_clt_dev *dev = block_device->bd_disk->private_data;
927 
928 	if (get_disk_ro(dev->gd) && (mode & FMODE_WRITE))
929 		return -EPERM;
930 
931 	if (dev->dev_state == DEV_STATE_UNMAPPED ||
932 	    !rnbd_clt_get_dev(dev))
933 		return -EIO;
934 
935 	return 0;
936 }
937 
938 static void rnbd_client_release(struct gendisk *gen, fmode_t mode)
939 {
940 	struct rnbd_clt_dev *dev = gen->private_data;
941 
942 	rnbd_clt_put_dev(dev);
943 }
944 
945 static int rnbd_client_getgeo(struct block_device *block_device,
946 			      struct hd_geometry *geo)
947 {
948 	u64 size;
949 	struct rnbd_clt_dev *dev = block_device->bd_disk->private_data;
950 	struct queue_limits *limit = &dev->queue->limits;
951 
952 	size = dev->size * (limit->logical_block_size / SECTOR_SIZE);
953 	geo->cylinders	= size >> 6;	/* size/64 */
954 	geo->heads	= 4;
955 	geo->sectors	= 16;
956 	geo->start	= 0;
957 
958 	return 0;
959 }
960 
961 static const struct block_device_operations rnbd_client_ops = {
962 	.owner		= THIS_MODULE,
963 	.open		= rnbd_client_open,
964 	.release	= rnbd_client_release,
965 	.getgeo		= rnbd_client_getgeo
966 };
967 
968 /* The amount of data that belongs to an I/O and the amount of data that
969  * should be read or written to the disk (bi_size) can differ.
970  *
971  * E.g. When WRITE_SAME is used, only a small amount of data is
972  * transferred that is then written repeatedly over a lot of sectors.
973  *
974  * Get the size of data to be transferred via RTRS by summing up the size
975  * of the scather-gather list entries.
976  */
977 static size_t rnbd_clt_get_sg_size(struct scatterlist *sglist, u32 len)
978 {
979 	struct scatterlist *sg;
980 	size_t tsize = 0;
981 	int i;
982 
983 	for_each_sg(sglist, sg, len, i)
984 		tsize += sg->length;
985 	return tsize;
986 }
987 
988 static int rnbd_client_xfer_request(struct rnbd_clt_dev *dev,
989 				     struct request *rq,
990 				     struct rnbd_iu *iu)
991 {
992 	struct rtrs_clt_sess *rtrs = dev->sess->rtrs;
993 	struct rtrs_permit *permit = iu->permit;
994 	struct rnbd_msg_io msg;
995 	struct rtrs_clt_req_ops req_ops;
996 	unsigned int sg_cnt = 0;
997 	struct kvec vec;
998 	size_t size;
999 	int err;
1000 
1001 	iu->rq		= rq;
1002 	iu->dev		= dev;
1003 	msg.sector	= cpu_to_le64(blk_rq_pos(rq));
1004 	msg.bi_size	= cpu_to_le32(blk_rq_bytes(rq));
1005 	msg.rw		= cpu_to_le32(rq_to_rnbd_flags(rq));
1006 	msg.prio	= cpu_to_le16(req_get_ioprio(rq));
1007 
1008 	/*
1009 	 * We only support discards with single segment for now.
1010 	 * See queue limits.
1011 	 */
1012 	if (req_op(rq) != REQ_OP_DISCARD)
1013 		sg_cnt = blk_rq_map_sg(dev->queue, rq, iu->sgt.sgl);
1014 
1015 	if (sg_cnt == 0)
1016 		sg_mark_end(&iu->sgt.sgl[0]);
1017 
1018 	msg.hdr.type	= cpu_to_le16(RNBD_MSG_IO);
1019 	msg.device_id	= cpu_to_le32(dev->device_id);
1020 
1021 	vec = (struct kvec) {
1022 		.iov_base = &msg,
1023 		.iov_len  = sizeof(msg)
1024 	};
1025 	size = rnbd_clt_get_sg_size(iu->sgt.sgl, sg_cnt);
1026 	req_ops = (struct rtrs_clt_req_ops) {
1027 		.priv = iu,
1028 		.conf_fn = msg_io_conf,
1029 	};
1030 	err = rtrs_clt_request(rq_data_dir(rq), &req_ops, rtrs, permit,
1031 			       &vec, 1, size, iu->sgt.sgl, sg_cnt);
1032 	if (err) {
1033 		rnbd_clt_err_rl(dev, "RTRS failed to transfer IO, err: %d\n",
1034 				 err);
1035 		return err;
1036 	}
1037 
1038 	return 0;
1039 }
1040 
1041 /**
1042  * rnbd_clt_dev_add_to_requeue() - add device to requeue if session is busy
1043  * @dev:	Device to be checked
1044  * @q:		Queue to be added to the requeue list if required
1045  *
1046  * Description:
1047  *     If session is busy, that means someone will requeue us when resources
1048  *     are freed.  If session is not doing anything - device is not added to
1049  *     the list and @false is returned.
1050  */
1051 static bool rnbd_clt_dev_add_to_requeue(struct rnbd_clt_dev *dev,
1052 						struct rnbd_queue *q)
1053 {
1054 	struct rnbd_clt_session *sess = dev->sess;
1055 	struct rnbd_cpu_qlist *cpu_q;
1056 	unsigned long flags;
1057 	bool added = true;
1058 	bool need_set;
1059 
1060 	cpu_q = get_cpu_ptr(sess->cpu_queues);
1061 	spin_lock_irqsave(&cpu_q->requeue_lock, flags);
1062 
1063 	if (!test_and_set_bit_lock(0, &q->in_list)) {
1064 		if (WARN_ON(!list_empty(&q->requeue_list)))
1065 			goto unlock;
1066 
1067 		need_set = !test_bit(cpu_q->cpu, sess->cpu_queues_bm);
1068 		if (need_set) {
1069 			set_bit(cpu_q->cpu, sess->cpu_queues_bm);
1070 			/* Paired with rnbd_put_permit(). Set a bit first
1071 			 * and then observe the busy counter.
1072 			 */
1073 			smp_mb__before_atomic();
1074 		}
1075 		if (atomic_read(&sess->busy)) {
1076 			list_add_tail(&q->requeue_list, &cpu_q->requeue_list);
1077 		} else {
1078 			/* Very unlikely, but possible: busy counter was
1079 			 * observed as zero.  Drop all bits and return
1080 			 * false to restart the queue by ourselves.
1081 			 */
1082 			if (need_set)
1083 				clear_bit(cpu_q->cpu, sess->cpu_queues_bm);
1084 			clear_bit_unlock(0, &q->in_list);
1085 			added = false;
1086 		}
1087 	}
1088 unlock:
1089 	spin_unlock_irqrestore(&cpu_q->requeue_lock, flags);
1090 	put_cpu_ptr(sess->cpu_queues);
1091 
1092 	return added;
1093 }
1094 
1095 static void rnbd_clt_dev_kick_mq_queue(struct rnbd_clt_dev *dev,
1096 					struct blk_mq_hw_ctx *hctx,
1097 					int delay)
1098 {
1099 	struct rnbd_queue *q = hctx->driver_data;
1100 
1101 	if (delay != RNBD_DELAY_IFBUSY)
1102 		blk_mq_delay_run_hw_queue(hctx, delay);
1103 	else if (!rnbd_clt_dev_add_to_requeue(dev, q))
1104 		/*
1105 		 * If session is not busy we have to restart
1106 		 * the queue ourselves.
1107 		 */
1108 		blk_mq_delay_run_hw_queue(hctx, 10/*ms*/);
1109 }
1110 
1111 static blk_status_t rnbd_queue_rq(struct blk_mq_hw_ctx *hctx,
1112 				   const struct blk_mq_queue_data *bd)
1113 {
1114 	struct request *rq = bd->rq;
1115 	struct rnbd_clt_dev *dev = rq->q->disk->private_data;
1116 	struct rnbd_iu *iu = blk_mq_rq_to_pdu(rq);
1117 	int err;
1118 	blk_status_t ret = BLK_STS_IOERR;
1119 
1120 	if (dev->dev_state != DEV_STATE_MAPPED)
1121 		return BLK_STS_IOERR;
1122 
1123 	iu->permit = rnbd_get_permit(dev->sess, RTRS_IO_CON,
1124 				      RTRS_PERMIT_NOWAIT);
1125 	if (!iu->permit) {
1126 		rnbd_clt_dev_kick_mq_queue(dev, hctx, RNBD_DELAY_IFBUSY);
1127 		return BLK_STS_RESOURCE;
1128 	}
1129 
1130 	iu->sgt.sgl = iu->first_sgl;
1131 	err = sg_alloc_table_chained(&iu->sgt,
1132 				     /* Even-if the request has no segment,
1133 				      * sglist must have one entry at least.
1134 				      */
1135 				     blk_rq_nr_phys_segments(rq) ? : 1,
1136 				     iu->sgt.sgl,
1137 				     RNBD_INLINE_SG_CNT);
1138 	if (err) {
1139 		rnbd_clt_err_rl(dev, "sg_alloc_table_chained ret=%d\n", err);
1140 		rnbd_clt_dev_kick_mq_queue(dev, hctx, 10/*ms*/);
1141 		rnbd_put_permit(dev->sess, iu->permit);
1142 		return BLK_STS_RESOURCE;
1143 	}
1144 
1145 	blk_mq_start_request(rq);
1146 	err = rnbd_client_xfer_request(dev, rq, iu);
1147 	if (err == 0)
1148 		return BLK_STS_OK;
1149 	if (err == -EAGAIN || err == -ENOMEM) {
1150 		rnbd_clt_dev_kick_mq_queue(dev, hctx, 10/*ms*/);
1151 		ret = BLK_STS_RESOURCE;
1152 	}
1153 	sg_free_table_chained(&iu->sgt, RNBD_INLINE_SG_CNT);
1154 	rnbd_put_permit(dev->sess, iu->permit);
1155 	return ret;
1156 }
1157 
1158 static int rnbd_rdma_poll(struct blk_mq_hw_ctx *hctx, struct io_comp_batch *iob)
1159 {
1160 	struct rnbd_queue *q = hctx->driver_data;
1161 	struct rnbd_clt_dev *dev = q->dev;
1162 	int cnt;
1163 
1164 	cnt = rtrs_clt_rdma_cq_direct(dev->sess->rtrs, hctx->queue_num);
1165 	return cnt;
1166 }
1167 
1168 static int rnbd_rdma_map_queues(struct blk_mq_tag_set *set)
1169 {
1170 	struct rnbd_clt_session *sess = set->driver_data;
1171 
1172 	/* shared read/write queues */
1173 	set->map[HCTX_TYPE_DEFAULT].nr_queues = num_online_cpus();
1174 	set->map[HCTX_TYPE_DEFAULT].queue_offset = 0;
1175 	set->map[HCTX_TYPE_READ].nr_queues = num_online_cpus();
1176 	set->map[HCTX_TYPE_READ].queue_offset = 0;
1177 	blk_mq_map_queues(&set->map[HCTX_TYPE_DEFAULT]);
1178 	blk_mq_map_queues(&set->map[HCTX_TYPE_READ]);
1179 
1180 	if (sess->nr_poll_queues) {
1181 		/* dedicated queue for poll */
1182 		set->map[HCTX_TYPE_POLL].nr_queues = sess->nr_poll_queues;
1183 		set->map[HCTX_TYPE_POLL].queue_offset = set->map[HCTX_TYPE_READ].queue_offset +
1184 			set->map[HCTX_TYPE_READ].nr_queues;
1185 		blk_mq_map_queues(&set->map[HCTX_TYPE_POLL]);
1186 		pr_info("[session=%s] mapped %d/%d/%d default/read/poll queues.\n",
1187 			sess->sessname,
1188 			set->map[HCTX_TYPE_DEFAULT].nr_queues,
1189 			set->map[HCTX_TYPE_READ].nr_queues,
1190 			set->map[HCTX_TYPE_POLL].nr_queues);
1191 	} else {
1192 		pr_info("[session=%s] mapped %d/%d default/read queues.\n",
1193 			sess->sessname,
1194 			set->map[HCTX_TYPE_DEFAULT].nr_queues,
1195 			set->map[HCTX_TYPE_READ].nr_queues);
1196 	}
1197 
1198 	return 0;
1199 }
1200 
1201 static struct blk_mq_ops rnbd_mq_ops = {
1202 	.queue_rq	= rnbd_queue_rq,
1203 	.complete	= rnbd_softirq_done_fn,
1204 	.map_queues     = rnbd_rdma_map_queues,
1205 	.poll           = rnbd_rdma_poll,
1206 };
1207 
1208 static int setup_mq_tags(struct rnbd_clt_session *sess)
1209 {
1210 	struct blk_mq_tag_set *tag_set = &sess->tag_set;
1211 
1212 	memset(tag_set, 0, sizeof(*tag_set));
1213 	tag_set->ops		= &rnbd_mq_ops;
1214 	tag_set->queue_depth	= sess->queue_depth;
1215 	tag_set->numa_node		= NUMA_NO_NODE;
1216 	tag_set->flags		= BLK_MQ_F_SHOULD_MERGE |
1217 				  BLK_MQ_F_TAG_QUEUE_SHARED;
1218 	tag_set->cmd_size	= sizeof(struct rnbd_iu) + RNBD_RDMA_SGL_SIZE;
1219 
1220 	/* for HCTX_TYPE_DEFAULT, HCTX_TYPE_READ, HCTX_TYPE_POLL */
1221 	tag_set->nr_maps        = sess->nr_poll_queues ? HCTX_MAX_TYPES : 2;
1222 	/*
1223 	 * HCTX_TYPE_DEFAULT and HCTX_TYPE_READ share one set of queues
1224 	 * others are for HCTX_TYPE_POLL
1225 	 */
1226 	tag_set->nr_hw_queues	= num_online_cpus() + sess->nr_poll_queues;
1227 	tag_set->driver_data    = sess;
1228 
1229 	return blk_mq_alloc_tag_set(tag_set);
1230 }
1231 
1232 static struct rnbd_clt_session *
1233 find_and_get_or_create_sess(const char *sessname,
1234 			    const struct rtrs_addr *paths,
1235 			    size_t path_cnt, u16 port_nr, u32 nr_poll_queues)
1236 {
1237 	struct rnbd_clt_session *sess;
1238 	struct rtrs_attrs attrs;
1239 	int err;
1240 	bool first = false;
1241 	struct rtrs_clt_ops rtrs_ops;
1242 
1243 	sess = find_or_create_sess(sessname, &first);
1244 	if (sess == ERR_PTR(-ENOMEM)) {
1245 		return ERR_PTR(-ENOMEM);
1246 	} else if ((nr_poll_queues && !first) ||  (!nr_poll_queues && sess->nr_poll_queues)) {
1247 		/*
1248 		 * A device MUST have its own session to use the polling-mode.
1249 		 * It must fail to map new device with the same session.
1250 		 */
1251 		err = -EINVAL;
1252 		goto put_sess;
1253 	}
1254 
1255 	if (!first)
1256 		return sess;
1257 
1258 	if (!path_cnt) {
1259 		pr_err("Session %s not found, and path parameter not given", sessname);
1260 		err = -ENXIO;
1261 		goto put_sess;
1262 	}
1263 
1264 	rtrs_ops = (struct rtrs_clt_ops) {
1265 		.priv = sess,
1266 		.link_ev = rnbd_clt_link_ev,
1267 	};
1268 	/*
1269 	 * Nothing was found, establish rtrs connection and proceed further.
1270 	 */
1271 	sess->rtrs = rtrs_clt_open(&rtrs_ops, sessname,
1272 				   paths, path_cnt, port_nr,
1273 				   0, /* Do not use pdu of rtrs */
1274 				   RECONNECT_DELAY,
1275 				   MAX_RECONNECTS, nr_poll_queues);
1276 	if (IS_ERR(sess->rtrs)) {
1277 		err = PTR_ERR(sess->rtrs);
1278 		goto wake_up_and_put;
1279 	}
1280 
1281 	err = rtrs_clt_query(sess->rtrs, &attrs);
1282 	if (err)
1283 		goto close_rtrs;
1284 
1285 	sess->max_io_size = attrs.max_io_size;
1286 	sess->queue_depth = attrs.queue_depth;
1287 	sess->nr_poll_queues = nr_poll_queues;
1288 	sess->max_segments = attrs.max_segments;
1289 
1290 	err = setup_mq_tags(sess);
1291 	if (err)
1292 		goto close_rtrs;
1293 
1294 	err = send_msg_sess_info(sess, RTRS_PERMIT_WAIT);
1295 	if (err)
1296 		goto close_rtrs;
1297 
1298 	wake_up_rtrs_waiters(sess);
1299 
1300 	return sess;
1301 
1302 close_rtrs:
1303 	close_rtrs(sess);
1304 put_sess:
1305 	rnbd_clt_put_sess(sess);
1306 
1307 	return ERR_PTR(err);
1308 
1309 wake_up_and_put:
1310 	wake_up_rtrs_waiters(sess);
1311 	goto put_sess;
1312 }
1313 
1314 static inline void rnbd_init_hw_queue(struct rnbd_clt_dev *dev,
1315 				       struct rnbd_queue *q,
1316 				       struct blk_mq_hw_ctx *hctx)
1317 {
1318 	INIT_LIST_HEAD(&q->requeue_list);
1319 	q->dev  = dev;
1320 	q->hctx = hctx;
1321 }
1322 
1323 static void rnbd_init_mq_hw_queues(struct rnbd_clt_dev *dev)
1324 {
1325 	unsigned long i;
1326 	struct blk_mq_hw_ctx *hctx;
1327 	struct rnbd_queue *q;
1328 
1329 	queue_for_each_hw_ctx(dev->queue, hctx, i) {
1330 		q = &dev->hw_queues[i];
1331 		rnbd_init_hw_queue(dev, q, hctx);
1332 		hctx->driver_data = q;
1333 	}
1334 }
1335 
1336 static void setup_request_queue(struct rnbd_clt_dev *dev,
1337 				struct rnbd_msg_open_rsp *rsp)
1338 {
1339 	blk_queue_logical_block_size(dev->queue,
1340 				     le16_to_cpu(rsp->logical_block_size));
1341 	blk_queue_physical_block_size(dev->queue,
1342 				      le16_to_cpu(rsp->physical_block_size));
1343 	blk_queue_max_hw_sectors(dev->queue,
1344 				 dev->sess->max_io_size / SECTOR_SIZE);
1345 
1346 	/*
1347 	 * we don't support discards to "discontiguous" segments
1348 	 * in on request
1349 	 */
1350 	blk_queue_max_discard_segments(dev->queue, 1);
1351 
1352 	blk_queue_max_discard_sectors(dev->queue,
1353 				      le32_to_cpu(rsp->max_discard_sectors));
1354 	dev->queue->limits.discard_granularity =
1355 					le32_to_cpu(rsp->discard_granularity);
1356 	dev->queue->limits.discard_alignment =
1357 					le32_to_cpu(rsp->discard_alignment);
1358 	if (le16_to_cpu(rsp->secure_discard))
1359 		blk_queue_max_secure_erase_sectors(dev->queue,
1360 					le32_to_cpu(rsp->max_discard_sectors));
1361 	blk_queue_flag_set(QUEUE_FLAG_SAME_COMP, dev->queue);
1362 	blk_queue_flag_set(QUEUE_FLAG_SAME_FORCE, dev->queue);
1363 	blk_queue_max_segments(dev->queue, dev->sess->max_segments);
1364 	blk_queue_io_opt(dev->queue, dev->sess->max_io_size);
1365 	blk_queue_virt_boundary(dev->queue, SZ_4K - 1);
1366 	blk_queue_write_cache(dev->queue,
1367 			      !!(rsp->cache_policy & RNBD_WRITEBACK),
1368 			      !!(rsp->cache_policy & RNBD_FUA));
1369 }
1370 
1371 static int rnbd_clt_setup_gen_disk(struct rnbd_clt_dev *dev,
1372 				   struct rnbd_msg_open_rsp *rsp, int idx)
1373 {
1374 	int err;
1375 
1376 	dev->gd->major		= rnbd_client_major;
1377 	dev->gd->first_minor	= idx << RNBD_PART_BITS;
1378 	dev->gd->minors		= 1 << RNBD_PART_BITS;
1379 	dev->gd->fops		= &rnbd_client_ops;
1380 	dev->gd->queue		= dev->queue;
1381 	dev->gd->private_data	= dev;
1382 	snprintf(dev->gd->disk_name, sizeof(dev->gd->disk_name), "rnbd%d",
1383 		 idx);
1384 	pr_debug("disk_name=%s, capacity=%llu\n",
1385 		 dev->gd->disk_name,
1386 		 le64_to_cpu(rsp->nsectors) *
1387 		 (le16_to_cpu(rsp->logical_block_size) / SECTOR_SIZE));
1388 
1389 	set_capacity(dev->gd, le64_to_cpu(rsp->nsectors));
1390 
1391 	if (dev->access_mode == RNBD_ACCESS_RO)
1392 		set_disk_ro(dev->gd, true);
1393 
1394 	/*
1395 	 * Network device does not need rotational
1396 	 */
1397 	blk_queue_flag_set(QUEUE_FLAG_NONROT, dev->queue);
1398 	err = add_disk(dev->gd);
1399 	if (err)
1400 		put_disk(dev->gd);
1401 
1402 	return err;
1403 }
1404 
1405 static int rnbd_client_setup_device(struct rnbd_clt_dev *dev,
1406 				    struct rnbd_msg_open_rsp *rsp)
1407 {
1408 	int idx = dev->clt_device_id;
1409 
1410 	dev->size = le64_to_cpu(rsp->nsectors) *
1411 			le16_to_cpu(rsp->logical_block_size);
1412 
1413 	dev->gd = blk_mq_alloc_disk(&dev->sess->tag_set, dev);
1414 	if (IS_ERR(dev->gd))
1415 		return PTR_ERR(dev->gd);
1416 	dev->queue = dev->gd->queue;
1417 	rnbd_init_mq_hw_queues(dev);
1418 
1419 	setup_request_queue(dev, rsp);
1420 	return rnbd_clt_setup_gen_disk(dev, rsp, idx);
1421 }
1422 
1423 static struct rnbd_clt_dev *init_dev(struct rnbd_clt_session *sess,
1424 				      enum rnbd_access_mode access_mode,
1425 				      const char *pathname,
1426 				      u32 nr_poll_queues)
1427 {
1428 	struct rnbd_clt_dev *dev;
1429 	int ret;
1430 
1431 	dev = kzalloc_node(sizeof(*dev), GFP_KERNEL, NUMA_NO_NODE);
1432 	if (!dev)
1433 		return ERR_PTR(-ENOMEM);
1434 
1435 	/*
1436 	 * nr_cpu_ids: the number of softirq queues
1437 	 * nr_poll_queues: the number of polling queues
1438 	 */
1439 	dev->hw_queues = kcalloc(nr_cpu_ids + nr_poll_queues,
1440 				 sizeof(*dev->hw_queues),
1441 				 GFP_KERNEL);
1442 	if (!dev->hw_queues) {
1443 		ret = -ENOMEM;
1444 		goto out_alloc;
1445 	}
1446 
1447 	ret = ida_alloc_max(&index_ida, 1 << (MINORBITS - RNBD_PART_BITS),
1448 			    GFP_KERNEL);
1449 	if (ret < 0) {
1450 		pr_err("Failed to initialize device '%s' from session %s, allocating idr failed, err: %d\n",
1451 		       pathname, sess->sessname, ret);
1452 		goto out_queues;
1453 	}
1454 
1455 	dev->pathname = kstrdup(pathname, GFP_KERNEL);
1456 	if (!dev->pathname) {
1457 		ret = -ENOMEM;
1458 		goto out_queues;
1459 	}
1460 
1461 	dev->clt_device_id	= ret;
1462 	dev->sess		= sess;
1463 	dev->access_mode	= access_mode;
1464 	dev->nr_poll_queues	= nr_poll_queues;
1465 	mutex_init(&dev->lock);
1466 	refcount_set(&dev->refcount, 1);
1467 	dev->dev_state = DEV_STATE_INIT;
1468 
1469 	/*
1470 	 * Here we called from sysfs entry, thus clt-sysfs is
1471 	 * responsible that session will not disappear.
1472 	 */
1473 	WARN_ON(!rnbd_clt_get_sess(sess));
1474 
1475 	return dev;
1476 
1477 out_queues:
1478 	kfree(dev->hw_queues);
1479 out_alloc:
1480 	kfree(dev);
1481 	return ERR_PTR(ret);
1482 }
1483 
1484 static bool __exists_dev(const char *pathname, const char *sessname)
1485 {
1486 	struct rnbd_clt_session *sess;
1487 	struct rnbd_clt_dev *dev;
1488 	bool found = false;
1489 
1490 	list_for_each_entry(sess, &sess_list, list) {
1491 		if (sessname && strncmp(sess->sessname, sessname,
1492 					sizeof(sess->sessname)))
1493 			continue;
1494 		mutex_lock(&sess->lock);
1495 		list_for_each_entry(dev, &sess->devs_list, list) {
1496 			if (strlen(dev->pathname) == strlen(pathname) &&
1497 			    !strcmp(dev->pathname, pathname)) {
1498 				found = true;
1499 				break;
1500 			}
1501 		}
1502 		mutex_unlock(&sess->lock);
1503 		if (found)
1504 			break;
1505 	}
1506 
1507 	return found;
1508 }
1509 
1510 static bool exists_devpath(const char *pathname, const char *sessname)
1511 {
1512 	bool found;
1513 
1514 	mutex_lock(&sess_lock);
1515 	found = __exists_dev(pathname, sessname);
1516 	mutex_unlock(&sess_lock);
1517 
1518 	return found;
1519 }
1520 
1521 static bool insert_dev_if_not_exists_devpath(struct rnbd_clt_dev *dev)
1522 {
1523 	bool found;
1524 	struct rnbd_clt_session *sess = dev->sess;
1525 
1526 	mutex_lock(&sess_lock);
1527 	found = __exists_dev(dev->pathname, sess->sessname);
1528 	if (!found) {
1529 		mutex_lock(&sess->lock);
1530 		list_add_tail(&dev->list, &sess->devs_list);
1531 		mutex_unlock(&sess->lock);
1532 	}
1533 	mutex_unlock(&sess_lock);
1534 
1535 	return found;
1536 }
1537 
1538 static void delete_dev(struct rnbd_clt_dev *dev)
1539 {
1540 	struct rnbd_clt_session *sess = dev->sess;
1541 
1542 	mutex_lock(&sess->lock);
1543 	list_del(&dev->list);
1544 	mutex_unlock(&sess->lock);
1545 }
1546 
1547 struct rnbd_clt_dev *rnbd_clt_map_device(const char *sessname,
1548 					   struct rtrs_addr *paths,
1549 					   size_t path_cnt, u16 port_nr,
1550 					   const char *pathname,
1551 					   enum rnbd_access_mode access_mode,
1552 					   u32 nr_poll_queues)
1553 {
1554 	struct rnbd_clt_session *sess;
1555 	struct rnbd_clt_dev *dev;
1556 	int ret, errno;
1557 	struct rnbd_msg_open_rsp *rsp;
1558 	struct rnbd_msg_open msg;
1559 	struct rnbd_iu *iu;
1560 	struct kvec vec = {
1561 		.iov_base = &msg,
1562 		.iov_len  = sizeof(msg)
1563 	};
1564 
1565 	if (exists_devpath(pathname, sessname))
1566 		return ERR_PTR(-EEXIST);
1567 
1568 	sess = find_and_get_or_create_sess(sessname, paths, path_cnt, port_nr, nr_poll_queues);
1569 	if (IS_ERR(sess))
1570 		return ERR_CAST(sess);
1571 
1572 	dev = init_dev(sess, access_mode, pathname, nr_poll_queues);
1573 	if (IS_ERR(dev)) {
1574 		pr_err("map_device: failed to map device '%s' from session %s, can't initialize device, err: %ld\n",
1575 		       pathname, sess->sessname, PTR_ERR(dev));
1576 		ret = PTR_ERR(dev);
1577 		goto put_sess;
1578 	}
1579 	if (insert_dev_if_not_exists_devpath(dev)) {
1580 		ret = -EEXIST;
1581 		goto put_dev;
1582 	}
1583 
1584 	rsp = kzalloc(sizeof(*rsp), GFP_KERNEL);
1585 	if (!rsp) {
1586 		ret = -ENOMEM;
1587 		goto del_dev;
1588 	}
1589 
1590 	iu = rnbd_get_iu(sess, RTRS_ADMIN_CON, RTRS_PERMIT_WAIT);
1591 	if (!iu) {
1592 		ret = -ENOMEM;
1593 		kfree(rsp);
1594 		goto del_dev;
1595 	}
1596 	iu->buf = rsp;
1597 	iu->dev = dev;
1598 	sg_init_one(iu->sgt.sgl, rsp, sizeof(*rsp));
1599 
1600 	msg.hdr.type    = cpu_to_le16(RNBD_MSG_OPEN);
1601 	msg.access_mode = dev->access_mode;
1602 	strscpy(msg.dev_name, dev->pathname, sizeof(msg.dev_name));
1603 
1604 	WARN_ON(!rnbd_clt_get_dev(dev));
1605 	ret = send_usr_msg(sess->rtrs, READ, iu,
1606 			   &vec, sizeof(*rsp), iu->sgt.sgl, 1,
1607 			   msg_open_conf, &errno, RTRS_PERMIT_WAIT);
1608 	if (ret) {
1609 		rnbd_clt_put_dev(dev);
1610 		rnbd_put_iu(sess, iu);
1611 	} else {
1612 		ret = errno;
1613 	}
1614 	if (ret) {
1615 		rnbd_clt_err(dev,
1616 			      "map_device: failed, can't open remote device, err: %d\n",
1617 			      ret);
1618 		goto put_iu;
1619 	}
1620 	mutex_lock(&dev->lock);
1621 	pr_debug("Opened remote device: session=%s, path='%s'\n",
1622 		 sess->sessname, pathname);
1623 	ret = rnbd_client_setup_device(dev, rsp);
1624 	if (ret) {
1625 		rnbd_clt_err(dev,
1626 			      "map_device: Failed to configure device, err: %d\n",
1627 			      ret);
1628 		mutex_unlock(&dev->lock);
1629 		goto send_close;
1630 	}
1631 
1632 	rnbd_clt_info(dev,
1633 		       "map_device: Device mapped as %s (nsectors: %llu, logical_block_size: %d, physical_block_size: %d, max_discard_sectors: %d, discard_granularity: %d, discard_alignment: %d, secure_discard: %d, max_segments: %d, max_hw_sectors: %d, wc: %d, fua: %d)\n",
1634 		       dev->gd->disk_name, le64_to_cpu(rsp->nsectors),
1635 		       le16_to_cpu(rsp->logical_block_size),
1636 		       le16_to_cpu(rsp->physical_block_size),
1637 		       le32_to_cpu(rsp->max_discard_sectors),
1638 		       le32_to_cpu(rsp->discard_granularity),
1639 		       le32_to_cpu(rsp->discard_alignment),
1640 		       le16_to_cpu(rsp->secure_discard),
1641 		       sess->max_segments, sess->max_io_size / SECTOR_SIZE,
1642 		       !!(rsp->cache_policy & RNBD_WRITEBACK),
1643 		       !!(rsp->cache_policy & RNBD_FUA));
1644 
1645 	mutex_unlock(&dev->lock);
1646 	kfree(rsp);
1647 	rnbd_put_iu(sess, iu);
1648 	rnbd_clt_put_sess(sess);
1649 
1650 	return dev;
1651 
1652 send_close:
1653 	send_msg_close(dev, dev->device_id, RTRS_PERMIT_WAIT);
1654 put_iu:
1655 	kfree(rsp);
1656 	rnbd_put_iu(sess, iu);
1657 del_dev:
1658 	delete_dev(dev);
1659 put_dev:
1660 	rnbd_clt_put_dev(dev);
1661 put_sess:
1662 	rnbd_clt_put_sess(sess);
1663 
1664 	return ERR_PTR(ret);
1665 }
1666 
1667 static void destroy_gen_disk(struct rnbd_clt_dev *dev)
1668 {
1669 	del_gendisk(dev->gd);
1670 	put_disk(dev->gd);
1671 }
1672 
1673 static void destroy_sysfs(struct rnbd_clt_dev *dev,
1674 			  const struct attribute *sysfs_self)
1675 {
1676 	rnbd_clt_remove_dev_symlink(dev);
1677 	if (dev->kobj.state_initialized) {
1678 		if (sysfs_self)
1679 			/* To avoid deadlock firstly remove itself */
1680 			sysfs_remove_file_self(&dev->kobj, sysfs_self);
1681 		kobject_del(&dev->kobj);
1682 		kobject_put(&dev->kobj);
1683 	}
1684 }
1685 
1686 int rnbd_clt_unmap_device(struct rnbd_clt_dev *dev, bool force,
1687 			   const struct attribute *sysfs_self)
1688 {
1689 	struct rnbd_clt_session *sess = dev->sess;
1690 	int refcount, ret = 0;
1691 	bool was_mapped;
1692 
1693 	mutex_lock(&dev->lock);
1694 	if (dev->dev_state == DEV_STATE_UNMAPPED) {
1695 		rnbd_clt_info(dev, "Device is already being unmapped\n");
1696 		ret = -EALREADY;
1697 		goto err;
1698 	}
1699 	refcount = refcount_read(&dev->refcount);
1700 	if (!force && refcount > 1) {
1701 		rnbd_clt_err(dev,
1702 			      "Closing device failed, device is in use, (%d device users)\n",
1703 			      refcount - 1);
1704 		ret = -EBUSY;
1705 		goto err;
1706 	}
1707 	was_mapped = (dev->dev_state == DEV_STATE_MAPPED);
1708 	dev->dev_state = DEV_STATE_UNMAPPED;
1709 	mutex_unlock(&dev->lock);
1710 
1711 	delete_dev(dev);
1712 	destroy_sysfs(dev, sysfs_self);
1713 	destroy_gen_disk(dev);
1714 	if (was_mapped && sess->rtrs)
1715 		send_msg_close(dev, dev->device_id, RTRS_PERMIT_WAIT);
1716 
1717 	rnbd_clt_info(dev, "Device is unmapped\n");
1718 
1719 	/* Likely last reference put */
1720 	rnbd_clt_put_dev(dev);
1721 
1722 	/*
1723 	 * Here device and session can be vanished!
1724 	 */
1725 
1726 	return 0;
1727 err:
1728 	mutex_unlock(&dev->lock);
1729 
1730 	return ret;
1731 }
1732 
1733 int rnbd_clt_remap_device(struct rnbd_clt_dev *dev)
1734 {
1735 	int err;
1736 
1737 	mutex_lock(&dev->lock);
1738 	if (dev->dev_state == DEV_STATE_MAPPED_DISCONNECTED)
1739 		err = 0;
1740 	else if (dev->dev_state == DEV_STATE_UNMAPPED)
1741 		err = -ENODEV;
1742 	else if (dev->dev_state == DEV_STATE_MAPPED)
1743 		err = -EALREADY;
1744 	else
1745 		err = -EBUSY;
1746 	mutex_unlock(&dev->lock);
1747 	if (!err) {
1748 		rnbd_clt_info(dev, "Remapping device.\n");
1749 		err = send_msg_open(dev, RTRS_PERMIT_WAIT);
1750 		if (err)
1751 			rnbd_clt_err(dev, "remap_device: %d\n", err);
1752 	}
1753 
1754 	return err;
1755 }
1756 
1757 static void unmap_device_work(struct work_struct *work)
1758 {
1759 	struct rnbd_clt_dev *dev;
1760 
1761 	dev = container_of(work, typeof(*dev), unmap_on_rmmod_work);
1762 	rnbd_clt_unmap_device(dev, true, NULL);
1763 }
1764 
1765 static void rnbd_destroy_sessions(void)
1766 {
1767 	struct rnbd_clt_session *sess, *sn;
1768 	struct rnbd_clt_dev *dev, *tn;
1769 
1770 	/* Firstly forbid access through sysfs interface */
1771 	rnbd_clt_destroy_sysfs_files();
1772 
1773 	/*
1774 	 * Here at this point there is no any concurrent access to sessions
1775 	 * list and devices list:
1776 	 *   1. New session or device can't be created - session sysfs files
1777 	 *      are removed.
1778 	 *   2. Device or session can't be removed - module reference is taken
1779 	 *      into account in unmap device sysfs callback.
1780 	 *   3. No IO requests inflight - each file open of block_dev increases
1781 	 *      module reference in get_disk().
1782 	 *
1783 	 * But still there can be user requests inflights, which are sent by
1784 	 * asynchronous send_msg_*() functions, thus before unmapping devices
1785 	 * RTRS session must be explicitly closed.
1786 	 */
1787 
1788 	list_for_each_entry_safe(sess, sn, &sess_list, list) {
1789 		if (!rnbd_clt_get_sess(sess))
1790 			continue;
1791 		close_rtrs(sess);
1792 		list_for_each_entry_safe(dev, tn, &sess->devs_list, list) {
1793 			/*
1794 			 * Here unmap happens in parallel for only one reason:
1795 			 * del_gendisk() takes around half a second, so
1796 			 * on huge amount of devices the whole module unload
1797 			 * procedure takes minutes.
1798 			 */
1799 			INIT_WORK(&dev->unmap_on_rmmod_work, unmap_device_work);
1800 			queue_work(rnbd_clt_wq, &dev->unmap_on_rmmod_work);
1801 		}
1802 		rnbd_clt_put_sess(sess);
1803 	}
1804 	/* Wait for all scheduled unmap works */
1805 	flush_workqueue(rnbd_clt_wq);
1806 	WARN_ON(!list_empty(&sess_list));
1807 }
1808 
1809 static int __init rnbd_client_init(void)
1810 {
1811 	int err = 0;
1812 
1813 	BUILD_BUG_ON(sizeof(struct rnbd_msg_hdr) != 4);
1814 	BUILD_BUG_ON(sizeof(struct rnbd_msg_sess_info) != 36);
1815 	BUILD_BUG_ON(sizeof(struct rnbd_msg_sess_info_rsp) != 36);
1816 	BUILD_BUG_ON(sizeof(struct rnbd_msg_open) != 264);
1817 	BUILD_BUG_ON(sizeof(struct rnbd_msg_close) != 8);
1818 	BUILD_BUG_ON(sizeof(struct rnbd_msg_open_rsp) != 56);
1819 	rnbd_client_major = register_blkdev(rnbd_client_major, "rnbd");
1820 	if (rnbd_client_major <= 0) {
1821 		pr_err("Failed to load module, block device registration failed\n");
1822 		return -EBUSY;
1823 	}
1824 
1825 	err = rnbd_clt_create_sysfs_files();
1826 	if (err) {
1827 		pr_err("Failed to load module, creating sysfs device files failed, err: %d\n",
1828 		       err);
1829 		unregister_blkdev(rnbd_client_major, "rnbd");
1830 		return err;
1831 	}
1832 	rnbd_clt_wq = alloc_workqueue("rnbd_clt_wq", 0, 0);
1833 	if (!rnbd_clt_wq) {
1834 		pr_err("Failed to load module, alloc_workqueue failed.\n");
1835 		rnbd_clt_destroy_sysfs_files();
1836 		unregister_blkdev(rnbd_client_major, "rnbd");
1837 		err = -ENOMEM;
1838 	}
1839 
1840 	return err;
1841 }
1842 
1843 static void __exit rnbd_client_exit(void)
1844 {
1845 	rnbd_destroy_sessions();
1846 	unregister_blkdev(rnbd_client_major, "rnbd");
1847 	ida_destroy(&index_ida);
1848 	destroy_workqueue(rnbd_clt_wq);
1849 }
1850 
1851 module_init(rnbd_client_init);
1852 module_exit(rnbd_client_exit);
1853