xref: /OK3568_Linux_fs/kernel/drivers/block/rnbd/rnbd-srv.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * RDMA Network Block Driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (c) 2014 - 2018 ProfitBricks GmbH. All rights reserved.
6*4882a593Smuzhiyun  * Copyright (c) 2018 - 2019 1&1 IONOS Cloud GmbH. All rights reserved.
7*4882a593Smuzhiyun  * Copyright (c) 2019 - 2020 1&1 IONOS SE. All rights reserved.
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun #undef pr_fmt
10*4882a593Smuzhiyun #define pr_fmt(fmt) KBUILD_MODNAME " L" __stringify(__LINE__) ": " fmt
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <linux/module.h>
13*4882a593Smuzhiyun #include <linux/blkdev.h>
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun #include "rnbd-srv.h"
16*4882a593Smuzhiyun #include "rnbd-srv-dev.h"
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun MODULE_DESCRIPTION("RDMA Network Block Device Server");
19*4882a593Smuzhiyun MODULE_LICENSE("GPL");
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun static u16 port_nr = RTRS_PORT;
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun module_param_named(port_nr, port_nr, ushort, 0444);
24*4882a593Smuzhiyun MODULE_PARM_DESC(port_nr,
25*4882a593Smuzhiyun 		 "The port number the server is listening on (default: "
26*4882a593Smuzhiyun 		 __stringify(RTRS_PORT)")");
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun #define DEFAULT_DEV_SEARCH_PATH "/"
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun static char dev_search_path[PATH_MAX] = DEFAULT_DEV_SEARCH_PATH;
31*4882a593Smuzhiyun 
dev_search_path_set(const char * val,const struct kernel_param * kp)32*4882a593Smuzhiyun static int dev_search_path_set(const char *val, const struct kernel_param *kp)
33*4882a593Smuzhiyun {
34*4882a593Smuzhiyun 	const char *p = strrchr(val, '\n') ? : val + strlen(val);
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun 	if (strlen(val) >= sizeof(dev_search_path))
37*4882a593Smuzhiyun 		return -EINVAL;
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun 	snprintf(dev_search_path, sizeof(dev_search_path), "%.*s",
40*4882a593Smuzhiyun 		 (int)(p - val), val);
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun 	pr_info("dev_search_path changed to '%s'\n", dev_search_path);
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun 	return 0;
45*4882a593Smuzhiyun }
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun static struct kparam_string dev_search_path_kparam_str = {
48*4882a593Smuzhiyun 	.maxlen	= sizeof(dev_search_path),
49*4882a593Smuzhiyun 	.string	= dev_search_path
50*4882a593Smuzhiyun };
51*4882a593Smuzhiyun 
52*4882a593Smuzhiyun static const struct kernel_param_ops dev_search_path_ops = {
53*4882a593Smuzhiyun 	.set	= dev_search_path_set,
54*4882a593Smuzhiyun 	.get	= param_get_string,
55*4882a593Smuzhiyun };
56*4882a593Smuzhiyun 
57*4882a593Smuzhiyun module_param_cb(dev_search_path, &dev_search_path_ops,
58*4882a593Smuzhiyun 		&dev_search_path_kparam_str, 0444);
59*4882a593Smuzhiyun MODULE_PARM_DESC(dev_search_path,
60*4882a593Smuzhiyun 		 "Sets the dev_search_path. When a device is mapped this path is prepended to the device path from the map device operation.  If %SESSNAME% is specified in a path, then device will be searched in a session namespace. (default: "
61*4882a593Smuzhiyun 		 DEFAULT_DEV_SEARCH_PATH ")");
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun static DEFINE_MUTEX(sess_lock);
64*4882a593Smuzhiyun static DEFINE_SPINLOCK(dev_lock);
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun static LIST_HEAD(sess_list);
67*4882a593Smuzhiyun static LIST_HEAD(dev_list);
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun struct rnbd_io_private {
70*4882a593Smuzhiyun 	struct rtrs_srv_op		*id;
71*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev	*sess_dev;
72*4882a593Smuzhiyun };
73*4882a593Smuzhiyun 
rnbd_sess_dev_release(struct kref * kref)74*4882a593Smuzhiyun static void rnbd_sess_dev_release(struct kref *kref)
75*4882a593Smuzhiyun {
76*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev *sess_dev;
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun 	sess_dev = container_of(kref, struct rnbd_srv_sess_dev, kref);
79*4882a593Smuzhiyun 	complete(sess_dev->destroy_comp);
80*4882a593Smuzhiyun }
81*4882a593Smuzhiyun 
rnbd_put_sess_dev(struct rnbd_srv_sess_dev * sess_dev)82*4882a593Smuzhiyun static inline void rnbd_put_sess_dev(struct rnbd_srv_sess_dev *sess_dev)
83*4882a593Smuzhiyun {
84*4882a593Smuzhiyun 	kref_put(&sess_dev->kref, rnbd_sess_dev_release);
85*4882a593Smuzhiyun }
86*4882a593Smuzhiyun 
rnbd_endio(void * priv,int error)87*4882a593Smuzhiyun void rnbd_endio(void *priv, int error)
88*4882a593Smuzhiyun {
89*4882a593Smuzhiyun 	struct rnbd_io_private *rnbd_priv = priv;
90*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev *sess_dev = rnbd_priv->sess_dev;
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun 	rnbd_put_sess_dev(sess_dev);
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun 	rtrs_srv_resp_rdma(rnbd_priv->id, error);
95*4882a593Smuzhiyun 
96*4882a593Smuzhiyun 	kfree(priv);
97*4882a593Smuzhiyun }
98*4882a593Smuzhiyun 
99*4882a593Smuzhiyun static struct rnbd_srv_sess_dev *
rnbd_get_sess_dev(int dev_id,struct rnbd_srv_session * srv_sess)100*4882a593Smuzhiyun rnbd_get_sess_dev(int dev_id, struct rnbd_srv_session *srv_sess)
101*4882a593Smuzhiyun {
102*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev *sess_dev;
103*4882a593Smuzhiyun 	int ret = 0;
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 	rcu_read_lock();
106*4882a593Smuzhiyun 	sess_dev = xa_load(&srv_sess->index_idr, dev_id);
107*4882a593Smuzhiyun 	if (likely(sess_dev))
108*4882a593Smuzhiyun 		ret = kref_get_unless_zero(&sess_dev->kref);
109*4882a593Smuzhiyun 	rcu_read_unlock();
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun 	if (!sess_dev || !ret)
112*4882a593Smuzhiyun 		return ERR_PTR(-ENXIO);
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun 	return sess_dev;
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun 
process_rdma(struct rtrs_srv * sess,struct rnbd_srv_session * srv_sess,struct rtrs_srv_op * id,void * data,u32 datalen,const void * usr,size_t usrlen)117*4882a593Smuzhiyun static int process_rdma(struct rtrs_srv *sess,
118*4882a593Smuzhiyun 			struct rnbd_srv_session *srv_sess,
119*4882a593Smuzhiyun 			struct rtrs_srv_op *id, void *data, u32 datalen,
120*4882a593Smuzhiyun 			const void *usr, size_t usrlen)
121*4882a593Smuzhiyun {
122*4882a593Smuzhiyun 	const struct rnbd_msg_io *msg = usr;
123*4882a593Smuzhiyun 	struct rnbd_io_private *priv;
124*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev *sess_dev;
125*4882a593Smuzhiyun 	u32 dev_id;
126*4882a593Smuzhiyun 	int err;
127*4882a593Smuzhiyun 	struct rnbd_dev_blk_io *io;
128*4882a593Smuzhiyun 	struct bio *bio;
129*4882a593Smuzhiyun 	short prio;
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun 	priv = kmalloc(sizeof(*priv), GFP_KERNEL);
132*4882a593Smuzhiyun 	if (!priv)
133*4882a593Smuzhiyun 		return -ENOMEM;
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun 	dev_id = le32_to_cpu(msg->device_id);
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun 	sess_dev = rnbd_get_sess_dev(dev_id, srv_sess);
138*4882a593Smuzhiyun 	if (IS_ERR(sess_dev)) {
139*4882a593Smuzhiyun 		pr_err_ratelimited("Got I/O request on session %s for unknown device id %d\n",
140*4882a593Smuzhiyun 				   srv_sess->sessname, dev_id);
141*4882a593Smuzhiyun 		err = -ENOTCONN;
142*4882a593Smuzhiyun 		goto err;
143*4882a593Smuzhiyun 	}
144*4882a593Smuzhiyun 
145*4882a593Smuzhiyun 	priv->sess_dev = sess_dev;
146*4882a593Smuzhiyun 	priv->id = id;
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun 	/* Generate bio with pages pointing to the rdma buffer */
149*4882a593Smuzhiyun 	bio = rnbd_bio_map_kern(data, sess_dev->rnbd_dev->ibd_bio_set, datalen, GFP_KERNEL);
150*4882a593Smuzhiyun 	if (IS_ERR(bio)) {
151*4882a593Smuzhiyun 		err = PTR_ERR(bio);
152*4882a593Smuzhiyun 		rnbd_srv_err(sess_dev, "Failed to generate bio, err: %d\n", err);
153*4882a593Smuzhiyun 		goto sess_dev_put;
154*4882a593Smuzhiyun 	}
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun 	io = container_of(bio, struct rnbd_dev_blk_io, bio);
157*4882a593Smuzhiyun 	io->dev = sess_dev->rnbd_dev;
158*4882a593Smuzhiyun 	io->priv = priv;
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun 	bio->bi_end_io = rnbd_dev_bi_end_io;
161*4882a593Smuzhiyun 	bio->bi_private = io;
162*4882a593Smuzhiyun 	bio->bi_opf = rnbd_to_bio_flags(le32_to_cpu(msg->rw));
163*4882a593Smuzhiyun 	bio->bi_iter.bi_sector = le64_to_cpu(msg->sector);
164*4882a593Smuzhiyun 	bio->bi_iter.bi_size = le32_to_cpu(msg->bi_size);
165*4882a593Smuzhiyun 	prio = srv_sess->ver < RNBD_PROTO_VER_MAJOR ||
166*4882a593Smuzhiyun 	       usrlen < sizeof(*msg) ? 0 : le16_to_cpu(msg->prio);
167*4882a593Smuzhiyun 	bio_set_prio(bio, prio);
168*4882a593Smuzhiyun 	bio_set_dev(bio, sess_dev->rnbd_dev->bdev);
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun 	submit_bio(bio);
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 	return 0;
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun sess_dev_put:
175*4882a593Smuzhiyun 	rnbd_put_sess_dev(sess_dev);
176*4882a593Smuzhiyun err:
177*4882a593Smuzhiyun 	kfree(priv);
178*4882a593Smuzhiyun 	return err;
179*4882a593Smuzhiyun }
180*4882a593Smuzhiyun 
destroy_device(struct rnbd_srv_dev * dev)181*4882a593Smuzhiyun static void destroy_device(struct rnbd_srv_dev *dev)
182*4882a593Smuzhiyun {
183*4882a593Smuzhiyun 	WARN_ONCE(!list_empty(&dev->sess_dev_list),
184*4882a593Smuzhiyun 		  "Device %s is being destroyed but still in use!\n",
185*4882a593Smuzhiyun 		  dev->id);
186*4882a593Smuzhiyun 
187*4882a593Smuzhiyun 	spin_lock(&dev_lock);
188*4882a593Smuzhiyun 	list_del(&dev->list);
189*4882a593Smuzhiyun 	spin_unlock(&dev_lock);
190*4882a593Smuzhiyun 
191*4882a593Smuzhiyun 	mutex_destroy(&dev->lock);
192*4882a593Smuzhiyun 	if (dev->dev_kobj.state_in_sysfs)
193*4882a593Smuzhiyun 		/*
194*4882a593Smuzhiyun 		 * Destroy kobj only if it was really created.
195*4882a593Smuzhiyun 		 */
196*4882a593Smuzhiyun 		rnbd_srv_destroy_dev_sysfs(dev);
197*4882a593Smuzhiyun 	else
198*4882a593Smuzhiyun 		kfree(dev);
199*4882a593Smuzhiyun }
200*4882a593Smuzhiyun 
destroy_device_cb(struct kref * kref)201*4882a593Smuzhiyun static void destroy_device_cb(struct kref *kref)
202*4882a593Smuzhiyun {
203*4882a593Smuzhiyun 	struct rnbd_srv_dev *dev;
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun 	dev = container_of(kref, struct rnbd_srv_dev, kref);
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	destroy_device(dev);
208*4882a593Smuzhiyun }
209*4882a593Smuzhiyun 
rnbd_put_srv_dev(struct rnbd_srv_dev * dev)210*4882a593Smuzhiyun static void rnbd_put_srv_dev(struct rnbd_srv_dev *dev)
211*4882a593Smuzhiyun {
212*4882a593Smuzhiyun 	kref_put(&dev->kref, destroy_device_cb);
213*4882a593Smuzhiyun }
214*4882a593Smuzhiyun 
rnbd_destroy_sess_dev(struct rnbd_srv_sess_dev * sess_dev)215*4882a593Smuzhiyun void rnbd_destroy_sess_dev(struct rnbd_srv_sess_dev *sess_dev)
216*4882a593Smuzhiyun {
217*4882a593Smuzhiyun 	DECLARE_COMPLETION_ONSTACK(dc);
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 	xa_erase(&sess_dev->sess->index_idr, sess_dev->device_id);
220*4882a593Smuzhiyun 	synchronize_rcu();
221*4882a593Smuzhiyun 	sess_dev->destroy_comp = &dc;
222*4882a593Smuzhiyun 	rnbd_put_sess_dev(sess_dev);
223*4882a593Smuzhiyun 	wait_for_completion(&dc); /* wait for inflights to drop to zero */
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	rnbd_dev_close(sess_dev->rnbd_dev);
226*4882a593Smuzhiyun 	list_del(&sess_dev->sess_list);
227*4882a593Smuzhiyun 	mutex_lock(&sess_dev->dev->lock);
228*4882a593Smuzhiyun 	list_del(&sess_dev->dev_list);
229*4882a593Smuzhiyun 	if (sess_dev->open_flags & FMODE_WRITE)
230*4882a593Smuzhiyun 		sess_dev->dev->open_write_cnt--;
231*4882a593Smuzhiyun 	mutex_unlock(&sess_dev->dev->lock);
232*4882a593Smuzhiyun 
233*4882a593Smuzhiyun 	rnbd_put_srv_dev(sess_dev->dev);
234*4882a593Smuzhiyun 
235*4882a593Smuzhiyun 	rnbd_srv_info(sess_dev, "Device closed\n");
236*4882a593Smuzhiyun 	kfree(sess_dev);
237*4882a593Smuzhiyun }
238*4882a593Smuzhiyun 
destroy_sess(struct rnbd_srv_session * srv_sess)239*4882a593Smuzhiyun static void destroy_sess(struct rnbd_srv_session *srv_sess)
240*4882a593Smuzhiyun {
241*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev *sess_dev, *tmp;
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 	if (list_empty(&srv_sess->sess_dev_list))
244*4882a593Smuzhiyun 		goto out;
245*4882a593Smuzhiyun 
246*4882a593Smuzhiyun 	mutex_lock(&srv_sess->lock);
247*4882a593Smuzhiyun 	list_for_each_entry_safe(sess_dev, tmp, &srv_sess->sess_dev_list,
248*4882a593Smuzhiyun 				 sess_list)
249*4882a593Smuzhiyun 		rnbd_srv_destroy_dev_session_sysfs(sess_dev);
250*4882a593Smuzhiyun 	mutex_unlock(&srv_sess->lock);
251*4882a593Smuzhiyun 
252*4882a593Smuzhiyun out:
253*4882a593Smuzhiyun 	xa_destroy(&srv_sess->index_idr);
254*4882a593Smuzhiyun 	bioset_exit(&srv_sess->sess_bio_set);
255*4882a593Smuzhiyun 
256*4882a593Smuzhiyun 	pr_info("RTRS Session %s disconnected\n", srv_sess->sessname);
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun 	mutex_lock(&sess_lock);
259*4882a593Smuzhiyun 	list_del(&srv_sess->list);
260*4882a593Smuzhiyun 	mutex_unlock(&sess_lock);
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 	mutex_destroy(&srv_sess->lock);
263*4882a593Smuzhiyun 	kfree(srv_sess);
264*4882a593Smuzhiyun }
265*4882a593Smuzhiyun 
create_sess(struct rtrs_srv * rtrs)266*4882a593Smuzhiyun static int create_sess(struct rtrs_srv *rtrs)
267*4882a593Smuzhiyun {
268*4882a593Smuzhiyun 	struct rnbd_srv_session *srv_sess;
269*4882a593Smuzhiyun 	char sessname[NAME_MAX];
270*4882a593Smuzhiyun 	int err;
271*4882a593Smuzhiyun 
272*4882a593Smuzhiyun 	err = rtrs_srv_get_sess_name(rtrs, sessname, sizeof(sessname));
273*4882a593Smuzhiyun 	if (err) {
274*4882a593Smuzhiyun 		pr_err("rtrs_srv_get_sess_name(%s): %d\n", sessname, err);
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 		return err;
277*4882a593Smuzhiyun 	}
278*4882a593Smuzhiyun 	srv_sess = kzalloc(sizeof(*srv_sess), GFP_KERNEL);
279*4882a593Smuzhiyun 	if (!srv_sess)
280*4882a593Smuzhiyun 		return -ENOMEM;
281*4882a593Smuzhiyun 
282*4882a593Smuzhiyun 	srv_sess->queue_depth = rtrs_srv_get_queue_depth(rtrs);
283*4882a593Smuzhiyun 	err = bioset_init(&srv_sess->sess_bio_set, srv_sess->queue_depth,
284*4882a593Smuzhiyun 			  offsetof(struct rnbd_dev_blk_io, bio),
285*4882a593Smuzhiyun 			  BIOSET_NEED_BVECS);
286*4882a593Smuzhiyun 	if (err) {
287*4882a593Smuzhiyun 		pr_err("Allocating srv_session for session %s failed\n",
288*4882a593Smuzhiyun 		       sessname);
289*4882a593Smuzhiyun 		kfree(srv_sess);
290*4882a593Smuzhiyun 		return err;
291*4882a593Smuzhiyun 	}
292*4882a593Smuzhiyun 
293*4882a593Smuzhiyun 	xa_init_flags(&srv_sess->index_idr, XA_FLAGS_ALLOC);
294*4882a593Smuzhiyun 	INIT_LIST_HEAD(&srv_sess->sess_dev_list);
295*4882a593Smuzhiyun 	mutex_init(&srv_sess->lock);
296*4882a593Smuzhiyun 	mutex_lock(&sess_lock);
297*4882a593Smuzhiyun 	list_add(&srv_sess->list, &sess_list);
298*4882a593Smuzhiyun 	mutex_unlock(&sess_lock);
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 	srv_sess->rtrs = rtrs;
301*4882a593Smuzhiyun 	strlcpy(srv_sess->sessname, sessname, sizeof(srv_sess->sessname));
302*4882a593Smuzhiyun 
303*4882a593Smuzhiyun 	rtrs_srv_set_sess_priv(rtrs, srv_sess);
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun 	return 0;
306*4882a593Smuzhiyun }
307*4882a593Smuzhiyun 
rnbd_srv_link_ev(struct rtrs_srv * rtrs,enum rtrs_srv_link_ev ev,void * priv)308*4882a593Smuzhiyun static int rnbd_srv_link_ev(struct rtrs_srv *rtrs,
309*4882a593Smuzhiyun 			     enum rtrs_srv_link_ev ev, void *priv)
310*4882a593Smuzhiyun {
311*4882a593Smuzhiyun 	struct rnbd_srv_session *srv_sess = priv;
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	switch (ev) {
314*4882a593Smuzhiyun 	case RTRS_SRV_LINK_EV_CONNECTED:
315*4882a593Smuzhiyun 		return create_sess(rtrs);
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun 	case RTRS_SRV_LINK_EV_DISCONNECTED:
318*4882a593Smuzhiyun 		if (WARN_ON_ONCE(!srv_sess))
319*4882a593Smuzhiyun 			return -EINVAL;
320*4882a593Smuzhiyun 
321*4882a593Smuzhiyun 		destroy_sess(srv_sess);
322*4882a593Smuzhiyun 		return 0;
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 	default:
325*4882a593Smuzhiyun 		pr_warn("Received unknown RTRS session event %d from session %s\n",
326*4882a593Smuzhiyun 			ev, srv_sess->sessname);
327*4882a593Smuzhiyun 		return -EINVAL;
328*4882a593Smuzhiyun 	}
329*4882a593Smuzhiyun }
330*4882a593Smuzhiyun 
process_msg_close(struct rtrs_srv * rtrs,struct rnbd_srv_session * srv_sess,void * data,size_t datalen,const void * usr,size_t usrlen)331*4882a593Smuzhiyun static int process_msg_close(struct rtrs_srv *rtrs,
332*4882a593Smuzhiyun 			     struct rnbd_srv_session *srv_sess,
333*4882a593Smuzhiyun 			     void *data, size_t datalen, const void *usr,
334*4882a593Smuzhiyun 			     size_t usrlen)
335*4882a593Smuzhiyun {
336*4882a593Smuzhiyun 	const struct rnbd_msg_close *close_msg = usr;
337*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev *sess_dev;
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	sess_dev = rnbd_get_sess_dev(le32_to_cpu(close_msg->device_id),
340*4882a593Smuzhiyun 				      srv_sess);
341*4882a593Smuzhiyun 	if (IS_ERR(sess_dev))
342*4882a593Smuzhiyun 		return 0;
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun 	rnbd_put_sess_dev(sess_dev);
345*4882a593Smuzhiyun 	mutex_lock(&srv_sess->lock);
346*4882a593Smuzhiyun 	rnbd_srv_destroy_dev_session_sysfs(sess_dev);
347*4882a593Smuzhiyun 	mutex_unlock(&srv_sess->lock);
348*4882a593Smuzhiyun 	return 0;
349*4882a593Smuzhiyun }
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun static int process_msg_open(struct rtrs_srv *rtrs,
352*4882a593Smuzhiyun 			    struct rnbd_srv_session *srv_sess,
353*4882a593Smuzhiyun 			    const void *msg, size_t len,
354*4882a593Smuzhiyun 			    void *data, size_t datalen);
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun static int process_msg_sess_info(struct rtrs_srv *rtrs,
357*4882a593Smuzhiyun 				 struct rnbd_srv_session *srv_sess,
358*4882a593Smuzhiyun 				 const void *msg, size_t len,
359*4882a593Smuzhiyun 				 void *data, size_t datalen);
360*4882a593Smuzhiyun 
rnbd_srv_rdma_ev(struct rtrs_srv * rtrs,void * priv,struct rtrs_srv_op * id,int dir,void * data,size_t datalen,const void * usr,size_t usrlen)361*4882a593Smuzhiyun static int rnbd_srv_rdma_ev(struct rtrs_srv *rtrs, void *priv,
362*4882a593Smuzhiyun 			     struct rtrs_srv_op *id, int dir,
363*4882a593Smuzhiyun 			     void *data, size_t datalen, const void *usr,
364*4882a593Smuzhiyun 			     size_t usrlen)
365*4882a593Smuzhiyun {
366*4882a593Smuzhiyun 	struct rnbd_srv_session *srv_sess = priv;
367*4882a593Smuzhiyun 	const struct rnbd_msg_hdr *hdr = usr;
368*4882a593Smuzhiyun 	int ret = 0;
369*4882a593Smuzhiyun 	u16 type;
370*4882a593Smuzhiyun 
371*4882a593Smuzhiyun 	if (WARN_ON_ONCE(!srv_sess))
372*4882a593Smuzhiyun 		return -ENODEV;
373*4882a593Smuzhiyun 
374*4882a593Smuzhiyun 	type = le16_to_cpu(hdr->type);
375*4882a593Smuzhiyun 
376*4882a593Smuzhiyun 	switch (type) {
377*4882a593Smuzhiyun 	case RNBD_MSG_IO:
378*4882a593Smuzhiyun 		return process_rdma(rtrs, srv_sess, id, data, datalen, usr,
379*4882a593Smuzhiyun 				    usrlen);
380*4882a593Smuzhiyun 	case RNBD_MSG_CLOSE:
381*4882a593Smuzhiyun 		ret = process_msg_close(rtrs, srv_sess, data, datalen,
382*4882a593Smuzhiyun 					usr, usrlen);
383*4882a593Smuzhiyun 		break;
384*4882a593Smuzhiyun 	case RNBD_MSG_OPEN:
385*4882a593Smuzhiyun 		ret = process_msg_open(rtrs, srv_sess, usr, usrlen,
386*4882a593Smuzhiyun 				       data, datalen);
387*4882a593Smuzhiyun 		break;
388*4882a593Smuzhiyun 	case RNBD_MSG_SESS_INFO:
389*4882a593Smuzhiyun 		ret = process_msg_sess_info(rtrs, srv_sess, usr, usrlen,
390*4882a593Smuzhiyun 					    data, datalen);
391*4882a593Smuzhiyun 		break;
392*4882a593Smuzhiyun 	default:
393*4882a593Smuzhiyun 		pr_warn("Received unexpected message type %d with dir %d from session %s\n",
394*4882a593Smuzhiyun 			type, dir, srv_sess->sessname);
395*4882a593Smuzhiyun 		return -EINVAL;
396*4882a593Smuzhiyun 	}
397*4882a593Smuzhiyun 
398*4882a593Smuzhiyun 	rtrs_srv_resp_rdma(id, ret);
399*4882a593Smuzhiyun 	return 0;
400*4882a593Smuzhiyun }
401*4882a593Smuzhiyun 
402*4882a593Smuzhiyun static struct rnbd_srv_sess_dev
rnbd_sess_dev_alloc(struct rnbd_srv_session * srv_sess)403*4882a593Smuzhiyun *rnbd_sess_dev_alloc(struct rnbd_srv_session *srv_sess)
404*4882a593Smuzhiyun {
405*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev *sess_dev;
406*4882a593Smuzhiyun 	int error;
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun 	sess_dev = kzalloc(sizeof(*sess_dev), GFP_KERNEL);
409*4882a593Smuzhiyun 	if (!sess_dev)
410*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
411*4882a593Smuzhiyun 
412*4882a593Smuzhiyun 	error = xa_alloc(&srv_sess->index_idr, &sess_dev->device_id, sess_dev,
413*4882a593Smuzhiyun 			 xa_limit_32b, GFP_NOWAIT);
414*4882a593Smuzhiyun 	if (error < 0) {
415*4882a593Smuzhiyun 		pr_warn("Allocating idr failed, err: %d\n", error);
416*4882a593Smuzhiyun 		kfree(sess_dev);
417*4882a593Smuzhiyun 		return ERR_PTR(error);
418*4882a593Smuzhiyun 	}
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun 	return sess_dev;
421*4882a593Smuzhiyun }
422*4882a593Smuzhiyun 
rnbd_srv_init_srv_dev(const char * id)423*4882a593Smuzhiyun static struct rnbd_srv_dev *rnbd_srv_init_srv_dev(const char *id)
424*4882a593Smuzhiyun {
425*4882a593Smuzhiyun 	struct rnbd_srv_dev *dev;
426*4882a593Smuzhiyun 
427*4882a593Smuzhiyun 	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
428*4882a593Smuzhiyun 	if (!dev)
429*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun 	strlcpy(dev->id, id, sizeof(dev->id));
432*4882a593Smuzhiyun 	kref_init(&dev->kref);
433*4882a593Smuzhiyun 	INIT_LIST_HEAD(&dev->sess_dev_list);
434*4882a593Smuzhiyun 	mutex_init(&dev->lock);
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 	return dev;
437*4882a593Smuzhiyun }
438*4882a593Smuzhiyun 
439*4882a593Smuzhiyun static struct rnbd_srv_dev *
rnbd_srv_find_or_add_srv_dev(struct rnbd_srv_dev * new_dev)440*4882a593Smuzhiyun rnbd_srv_find_or_add_srv_dev(struct rnbd_srv_dev *new_dev)
441*4882a593Smuzhiyun {
442*4882a593Smuzhiyun 	struct rnbd_srv_dev *dev;
443*4882a593Smuzhiyun 
444*4882a593Smuzhiyun 	spin_lock(&dev_lock);
445*4882a593Smuzhiyun 	list_for_each_entry(dev, &dev_list, list) {
446*4882a593Smuzhiyun 		if (!strncmp(dev->id, new_dev->id, sizeof(dev->id))) {
447*4882a593Smuzhiyun 			if (!kref_get_unless_zero(&dev->kref))
448*4882a593Smuzhiyun 				/*
449*4882a593Smuzhiyun 				 * We lost the race, device is almost dead.
450*4882a593Smuzhiyun 				 *  Continue traversing to find a valid one.
451*4882a593Smuzhiyun 				 */
452*4882a593Smuzhiyun 				continue;
453*4882a593Smuzhiyun 			spin_unlock(&dev_lock);
454*4882a593Smuzhiyun 			return dev;
455*4882a593Smuzhiyun 		}
456*4882a593Smuzhiyun 	}
457*4882a593Smuzhiyun 	list_add(&new_dev->list, &dev_list);
458*4882a593Smuzhiyun 	spin_unlock(&dev_lock);
459*4882a593Smuzhiyun 
460*4882a593Smuzhiyun 	return new_dev;
461*4882a593Smuzhiyun }
462*4882a593Smuzhiyun 
rnbd_srv_check_update_open_perm(struct rnbd_srv_dev * srv_dev,struct rnbd_srv_session * srv_sess,enum rnbd_access_mode access_mode)463*4882a593Smuzhiyun static int rnbd_srv_check_update_open_perm(struct rnbd_srv_dev *srv_dev,
464*4882a593Smuzhiyun 					    struct rnbd_srv_session *srv_sess,
465*4882a593Smuzhiyun 					    enum rnbd_access_mode access_mode)
466*4882a593Smuzhiyun {
467*4882a593Smuzhiyun 	int ret = -EPERM;
468*4882a593Smuzhiyun 
469*4882a593Smuzhiyun 	mutex_lock(&srv_dev->lock);
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 	switch (access_mode) {
472*4882a593Smuzhiyun 	case RNBD_ACCESS_RO:
473*4882a593Smuzhiyun 		ret = 0;
474*4882a593Smuzhiyun 		break;
475*4882a593Smuzhiyun 	case RNBD_ACCESS_RW:
476*4882a593Smuzhiyun 		if (srv_dev->open_write_cnt == 0)  {
477*4882a593Smuzhiyun 			srv_dev->open_write_cnt++;
478*4882a593Smuzhiyun 			ret = 0;
479*4882a593Smuzhiyun 		} else {
480*4882a593Smuzhiyun 			pr_err("Mapping device '%s' for session %s with RW permissions failed. Device already opened as 'RW' by %d client(s), access mode %s.\n",
481*4882a593Smuzhiyun 			       srv_dev->id, srv_sess->sessname,
482*4882a593Smuzhiyun 			       srv_dev->open_write_cnt,
483*4882a593Smuzhiyun 			       rnbd_access_mode_str(access_mode));
484*4882a593Smuzhiyun 		}
485*4882a593Smuzhiyun 		break;
486*4882a593Smuzhiyun 	case RNBD_ACCESS_MIGRATION:
487*4882a593Smuzhiyun 		if (srv_dev->open_write_cnt < 2) {
488*4882a593Smuzhiyun 			srv_dev->open_write_cnt++;
489*4882a593Smuzhiyun 			ret = 0;
490*4882a593Smuzhiyun 		} else {
491*4882a593Smuzhiyun 			pr_err("Mapping device '%s' for session %s with migration permissions failed. Device already opened as 'RW' by %d client(s), access mode %s.\n",
492*4882a593Smuzhiyun 			       srv_dev->id, srv_sess->sessname,
493*4882a593Smuzhiyun 			       srv_dev->open_write_cnt,
494*4882a593Smuzhiyun 			       rnbd_access_mode_str(access_mode));
495*4882a593Smuzhiyun 		}
496*4882a593Smuzhiyun 		break;
497*4882a593Smuzhiyun 	default:
498*4882a593Smuzhiyun 		pr_err("Received mapping request for device '%s' on session %s with invalid access mode: %d\n",
499*4882a593Smuzhiyun 		       srv_dev->id, srv_sess->sessname, access_mode);
500*4882a593Smuzhiyun 		ret = -EINVAL;
501*4882a593Smuzhiyun 	}
502*4882a593Smuzhiyun 
503*4882a593Smuzhiyun 	mutex_unlock(&srv_dev->lock);
504*4882a593Smuzhiyun 
505*4882a593Smuzhiyun 	return ret;
506*4882a593Smuzhiyun }
507*4882a593Smuzhiyun 
508*4882a593Smuzhiyun static struct rnbd_srv_dev *
rnbd_srv_get_or_create_srv_dev(struct rnbd_dev * rnbd_dev,struct rnbd_srv_session * srv_sess,enum rnbd_access_mode access_mode)509*4882a593Smuzhiyun rnbd_srv_get_or_create_srv_dev(struct rnbd_dev *rnbd_dev,
510*4882a593Smuzhiyun 				struct rnbd_srv_session *srv_sess,
511*4882a593Smuzhiyun 				enum rnbd_access_mode access_mode)
512*4882a593Smuzhiyun {
513*4882a593Smuzhiyun 	int ret;
514*4882a593Smuzhiyun 	struct rnbd_srv_dev *new_dev, *dev;
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun 	new_dev = rnbd_srv_init_srv_dev(rnbd_dev->name);
517*4882a593Smuzhiyun 	if (IS_ERR(new_dev))
518*4882a593Smuzhiyun 		return new_dev;
519*4882a593Smuzhiyun 
520*4882a593Smuzhiyun 	dev = rnbd_srv_find_or_add_srv_dev(new_dev);
521*4882a593Smuzhiyun 	if (dev != new_dev)
522*4882a593Smuzhiyun 		kfree(new_dev);
523*4882a593Smuzhiyun 
524*4882a593Smuzhiyun 	ret = rnbd_srv_check_update_open_perm(dev, srv_sess, access_mode);
525*4882a593Smuzhiyun 	if (ret) {
526*4882a593Smuzhiyun 		rnbd_put_srv_dev(dev);
527*4882a593Smuzhiyun 		return ERR_PTR(ret);
528*4882a593Smuzhiyun 	}
529*4882a593Smuzhiyun 
530*4882a593Smuzhiyun 	return dev;
531*4882a593Smuzhiyun }
532*4882a593Smuzhiyun 
rnbd_srv_fill_msg_open_rsp(struct rnbd_msg_open_rsp * rsp,struct rnbd_srv_sess_dev * sess_dev)533*4882a593Smuzhiyun static void rnbd_srv_fill_msg_open_rsp(struct rnbd_msg_open_rsp *rsp,
534*4882a593Smuzhiyun 					struct rnbd_srv_sess_dev *sess_dev)
535*4882a593Smuzhiyun {
536*4882a593Smuzhiyun 	struct rnbd_dev *rnbd_dev = sess_dev->rnbd_dev;
537*4882a593Smuzhiyun 
538*4882a593Smuzhiyun 	rsp->hdr.type = cpu_to_le16(RNBD_MSG_OPEN_RSP);
539*4882a593Smuzhiyun 	rsp->device_id =
540*4882a593Smuzhiyun 		cpu_to_le32(sess_dev->device_id);
541*4882a593Smuzhiyun 	rsp->nsectors =
542*4882a593Smuzhiyun 		cpu_to_le64(get_capacity(rnbd_dev->bdev->bd_disk));
543*4882a593Smuzhiyun 	rsp->logical_block_size	=
544*4882a593Smuzhiyun 		cpu_to_le16(bdev_logical_block_size(rnbd_dev->bdev));
545*4882a593Smuzhiyun 	rsp->physical_block_size =
546*4882a593Smuzhiyun 		cpu_to_le16(bdev_physical_block_size(rnbd_dev->bdev));
547*4882a593Smuzhiyun 	rsp->max_segments =
548*4882a593Smuzhiyun 		cpu_to_le16(rnbd_dev_get_max_segs(rnbd_dev));
549*4882a593Smuzhiyun 	rsp->max_hw_sectors =
550*4882a593Smuzhiyun 		cpu_to_le32(rnbd_dev_get_max_hw_sects(rnbd_dev));
551*4882a593Smuzhiyun 	rsp->max_write_same_sectors =
552*4882a593Smuzhiyun 		cpu_to_le32(bdev_write_same(rnbd_dev->bdev));
553*4882a593Smuzhiyun 	rsp->max_discard_sectors =
554*4882a593Smuzhiyun 		cpu_to_le32(rnbd_dev_get_max_discard_sects(rnbd_dev));
555*4882a593Smuzhiyun 	rsp->discard_granularity =
556*4882a593Smuzhiyun 		cpu_to_le32(rnbd_dev_get_discard_granularity(rnbd_dev));
557*4882a593Smuzhiyun 	rsp->discard_alignment =
558*4882a593Smuzhiyun 		cpu_to_le32(rnbd_dev_get_discard_alignment(rnbd_dev));
559*4882a593Smuzhiyun 	rsp->secure_discard =
560*4882a593Smuzhiyun 		cpu_to_le16(rnbd_dev_get_secure_discard(rnbd_dev));
561*4882a593Smuzhiyun 	rsp->rotational =
562*4882a593Smuzhiyun 		!blk_queue_nonrot(bdev_get_queue(rnbd_dev->bdev));
563*4882a593Smuzhiyun }
564*4882a593Smuzhiyun 
565*4882a593Smuzhiyun static struct rnbd_srv_sess_dev *
rnbd_srv_create_set_sess_dev(struct rnbd_srv_session * srv_sess,const struct rnbd_msg_open * open_msg,struct rnbd_dev * rnbd_dev,fmode_t open_flags,struct rnbd_srv_dev * srv_dev)566*4882a593Smuzhiyun rnbd_srv_create_set_sess_dev(struct rnbd_srv_session *srv_sess,
567*4882a593Smuzhiyun 			      const struct rnbd_msg_open *open_msg,
568*4882a593Smuzhiyun 			      struct rnbd_dev *rnbd_dev, fmode_t open_flags,
569*4882a593Smuzhiyun 			      struct rnbd_srv_dev *srv_dev)
570*4882a593Smuzhiyun {
571*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev *sdev = rnbd_sess_dev_alloc(srv_sess);
572*4882a593Smuzhiyun 
573*4882a593Smuzhiyun 	if (IS_ERR(sdev))
574*4882a593Smuzhiyun 		return sdev;
575*4882a593Smuzhiyun 
576*4882a593Smuzhiyun 	kref_init(&sdev->kref);
577*4882a593Smuzhiyun 
578*4882a593Smuzhiyun 	strlcpy(sdev->pathname, open_msg->dev_name, sizeof(sdev->pathname));
579*4882a593Smuzhiyun 
580*4882a593Smuzhiyun 	sdev->rnbd_dev		= rnbd_dev;
581*4882a593Smuzhiyun 	sdev->sess		= srv_sess;
582*4882a593Smuzhiyun 	sdev->dev		= srv_dev;
583*4882a593Smuzhiyun 	sdev->open_flags	= open_flags;
584*4882a593Smuzhiyun 	sdev->access_mode	= open_msg->access_mode;
585*4882a593Smuzhiyun 
586*4882a593Smuzhiyun 	return sdev;
587*4882a593Smuzhiyun }
588*4882a593Smuzhiyun 
rnbd_srv_get_full_path(struct rnbd_srv_session * srv_sess,const char * dev_name)589*4882a593Smuzhiyun static char *rnbd_srv_get_full_path(struct rnbd_srv_session *srv_sess,
590*4882a593Smuzhiyun 				     const char *dev_name)
591*4882a593Smuzhiyun {
592*4882a593Smuzhiyun 	char *full_path;
593*4882a593Smuzhiyun 	char *a, *b;
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun 	full_path = kmalloc(PATH_MAX, GFP_KERNEL);
596*4882a593Smuzhiyun 	if (!full_path)
597*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
598*4882a593Smuzhiyun 
599*4882a593Smuzhiyun 	/*
600*4882a593Smuzhiyun 	 * Replace %SESSNAME% with a real session name in order to
601*4882a593Smuzhiyun 	 * create device namespace.
602*4882a593Smuzhiyun 	 */
603*4882a593Smuzhiyun 	a = strnstr(dev_search_path, "%SESSNAME%", sizeof(dev_search_path));
604*4882a593Smuzhiyun 	if (a) {
605*4882a593Smuzhiyun 		int len = a - dev_search_path;
606*4882a593Smuzhiyun 
607*4882a593Smuzhiyun 		len = snprintf(full_path, PATH_MAX, "%.*s/%s/%s", len,
608*4882a593Smuzhiyun 			       dev_search_path, srv_sess->sessname, dev_name);
609*4882a593Smuzhiyun 		if (len >= PATH_MAX) {
610*4882a593Smuzhiyun 			pr_err("Too long path: %s, %s, %s\n",
611*4882a593Smuzhiyun 			       dev_search_path, srv_sess->sessname, dev_name);
612*4882a593Smuzhiyun 			kfree(full_path);
613*4882a593Smuzhiyun 			return ERR_PTR(-EINVAL);
614*4882a593Smuzhiyun 		}
615*4882a593Smuzhiyun 	} else {
616*4882a593Smuzhiyun 		snprintf(full_path, PATH_MAX, "%s/%s",
617*4882a593Smuzhiyun 			 dev_search_path, dev_name);
618*4882a593Smuzhiyun 	}
619*4882a593Smuzhiyun 
620*4882a593Smuzhiyun 	/* eliminitate duplicated slashes */
621*4882a593Smuzhiyun 	a = strchr(full_path, '/');
622*4882a593Smuzhiyun 	b = a;
623*4882a593Smuzhiyun 	while (*b != '\0') {
624*4882a593Smuzhiyun 		if (*b == '/' && *a == '/') {
625*4882a593Smuzhiyun 			b++;
626*4882a593Smuzhiyun 		} else {
627*4882a593Smuzhiyun 			a++;
628*4882a593Smuzhiyun 			*a = *b;
629*4882a593Smuzhiyun 			b++;
630*4882a593Smuzhiyun 		}
631*4882a593Smuzhiyun 	}
632*4882a593Smuzhiyun 	a++;
633*4882a593Smuzhiyun 	*a = '\0';
634*4882a593Smuzhiyun 
635*4882a593Smuzhiyun 	return full_path;
636*4882a593Smuzhiyun }
637*4882a593Smuzhiyun 
process_msg_sess_info(struct rtrs_srv * rtrs,struct rnbd_srv_session * srv_sess,const void * msg,size_t len,void * data,size_t datalen)638*4882a593Smuzhiyun static int process_msg_sess_info(struct rtrs_srv *rtrs,
639*4882a593Smuzhiyun 				 struct rnbd_srv_session *srv_sess,
640*4882a593Smuzhiyun 				 const void *msg, size_t len,
641*4882a593Smuzhiyun 				 void *data, size_t datalen)
642*4882a593Smuzhiyun {
643*4882a593Smuzhiyun 	const struct rnbd_msg_sess_info *sess_info_msg = msg;
644*4882a593Smuzhiyun 	struct rnbd_msg_sess_info_rsp *rsp = data;
645*4882a593Smuzhiyun 
646*4882a593Smuzhiyun 	srv_sess->ver = min_t(u8, sess_info_msg->ver, RNBD_PROTO_VER_MAJOR);
647*4882a593Smuzhiyun 	pr_debug("Session %s using protocol version %d (client version: %d, server version: %d)\n",
648*4882a593Smuzhiyun 		 srv_sess->sessname, srv_sess->ver,
649*4882a593Smuzhiyun 		 sess_info_msg->ver, RNBD_PROTO_VER_MAJOR);
650*4882a593Smuzhiyun 
651*4882a593Smuzhiyun 	rsp->hdr.type = cpu_to_le16(RNBD_MSG_SESS_INFO_RSP);
652*4882a593Smuzhiyun 	rsp->ver = srv_sess->ver;
653*4882a593Smuzhiyun 
654*4882a593Smuzhiyun 	return 0;
655*4882a593Smuzhiyun }
656*4882a593Smuzhiyun 
657*4882a593Smuzhiyun /**
658*4882a593Smuzhiyun  * find_srv_sess_dev() - a dev is already opened by this name
659*4882a593Smuzhiyun  * @srv_sess:	the session to search.
660*4882a593Smuzhiyun  * @dev_name:	string containing the name of the device.
661*4882a593Smuzhiyun  *
662*4882a593Smuzhiyun  * Return struct rnbd_srv_sess_dev if srv_sess already opened the dev_name
663*4882a593Smuzhiyun  * NULL if the session didn't open the device yet.
664*4882a593Smuzhiyun  */
665*4882a593Smuzhiyun static struct rnbd_srv_sess_dev *
find_srv_sess_dev(struct rnbd_srv_session * srv_sess,const char * dev_name)666*4882a593Smuzhiyun find_srv_sess_dev(struct rnbd_srv_session *srv_sess, const char *dev_name)
667*4882a593Smuzhiyun {
668*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev *sess_dev;
669*4882a593Smuzhiyun 
670*4882a593Smuzhiyun 	if (list_empty(&srv_sess->sess_dev_list))
671*4882a593Smuzhiyun 		return NULL;
672*4882a593Smuzhiyun 
673*4882a593Smuzhiyun 	list_for_each_entry(sess_dev, &srv_sess->sess_dev_list, sess_list)
674*4882a593Smuzhiyun 		if (!strcmp(sess_dev->pathname, dev_name))
675*4882a593Smuzhiyun 			return sess_dev;
676*4882a593Smuzhiyun 
677*4882a593Smuzhiyun 	return NULL;
678*4882a593Smuzhiyun }
679*4882a593Smuzhiyun 
process_msg_open(struct rtrs_srv * rtrs,struct rnbd_srv_session * srv_sess,const void * msg,size_t len,void * data,size_t datalen)680*4882a593Smuzhiyun static int process_msg_open(struct rtrs_srv *rtrs,
681*4882a593Smuzhiyun 			    struct rnbd_srv_session *srv_sess,
682*4882a593Smuzhiyun 			    const void *msg, size_t len,
683*4882a593Smuzhiyun 			    void *data, size_t datalen)
684*4882a593Smuzhiyun {
685*4882a593Smuzhiyun 	int ret;
686*4882a593Smuzhiyun 	struct rnbd_srv_dev *srv_dev;
687*4882a593Smuzhiyun 	struct rnbd_srv_sess_dev *srv_sess_dev;
688*4882a593Smuzhiyun 	const struct rnbd_msg_open *open_msg = msg;
689*4882a593Smuzhiyun 	fmode_t open_flags;
690*4882a593Smuzhiyun 	char *full_path;
691*4882a593Smuzhiyun 	struct rnbd_dev *rnbd_dev;
692*4882a593Smuzhiyun 	struct rnbd_msg_open_rsp *rsp = data;
693*4882a593Smuzhiyun 
694*4882a593Smuzhiyun 	pr_debug("Open message received: session='%s' path='%s' access_mode=%d\n",
695*4882a593Smuzhiyun 		 srv_sess->sessname, open_msg->dev_name,
696*4882a593Smuzhiyun 		 open_msg->access_mode);
697*4882a593Smuzhiyun 	open_flags = FMODE_READ;
698*4882a593Smuzhiyun 	if (open_msg->access_mode != RNBD_ACCESS_RO)
699*4882a593Smuzhiyun 		open_flags |= FMODE_WRITE;
700*4882a593Smuzhiyun 
701*4882a593Smuzhiyun 	mutex_lock(&srv_sess->lock);
702*4882a593Smuzhiyun 
703*4882a593Smuzhiyun 	srv_sess_dev = find_srv_sess_dev(srv_sess, open_msg->dev_name);
704*4882a593Smuzhiyun 	if (srv_sess_dev)
705*4882a593Smuzhiyun 		goto fill_response;
706*4882a593Smuzhiyun 
707*4882a593Smuzhiyun 	if ((strlen(dev_search_path) + strlen(open_msg->dev_name))
708*4882a593Smuzhiyun 	    >= PATH_MAX) {
709*4882a593Smuzhiyun 		pr_err("Opening device for session %s failed, device path too long. '%s/%s' is longer than PATH_MAX (%d)\n",
710*4882a593Smuzhiyun 		       srv_sess->sessname, dev_search_path, open_msg->dev_name,
711*4882a593Smuzhiyun 		       PATH_MAX);
712*4882a593Smuzhiyun 		ret = -EINVAL;
713*4882a593Smuzhiyun 		goto reject;
714*4882a593Smuzhiyun 	}
715*4882a593Smuzhiyun 	if (strstr(open_msg->dev_name, "..")) {
716*4882a593Smuzhiyun 		pr_err("Opening device for session %s failed, device path %s contains relative path ..\n",
717*4882a593Smuzhiyun 		       srv_sess->sessname, open_msg->dev_name);
718*4882a593Smuzhiyun 		ret = -EINVAL;
719*4882a593Smuzhiyun 		goto reject;
720*4882a593Smuzhiyun 	}
721*4882a593Smuzhiyun 	full_path = rnbd_srv_get_full_path(srv_sess, open_msg->dev_name);
722*4882a593Smuzhiyun 	if (IS_ERR(full_path)) {
723*4882a593Smuzhiyun 		ret = PTR_ERR(full_path);
724*4882a593Smuzhiyun 		pr_err("Opening device '%s' for client %s failed, failed to get device full path, err: %d\n",
725*4882a593Smuzhiyun 		       open_msg->dev_name, srv_sess->sessname, ret);
726*4882a593Smuzhiyun 		goto reject;
727*4882a593Smuzhiyun 	}
728*4882a593Smuzhiyun 
729*4882a593Smuzhiyun 	rnbd_dev = rnbd_dev_open(full_path, open_flags,
730*4882a593Smuzhiyun 				 &srv_sess->sess_bio_set);
731*4882a593Smuzhiyun 	if (IS_ERR(rnbd_dev)) {
732*4882a593Smuzhiyun 		pr_err("Opening device '%s' on session %s failed, failed to open the block device, err: %ld\n",
733*4882a593Smuzhiyun 		       full_path, srv_sess->sessname, PTR_ERR(rnbd_dev));
734*4882a593Smuzhiyun 		ret = PTR_ERR(rnbd_dev);
735*4882a593Smuzhiyun 		goto free_path;
736*4882a593Smuzhiyun 	}
737*4882a593Smuzhiyun 
738*4882a593Smuzhiyun 	srv_dev = rnbd_srv_get_or_create_srv_dev(rnbd_dev, srv_sess,
739*4882a593Smuzhiyun 						  open_msg->access_mode);
740*4882a593Smuzhiyun 	if (IS_ERR(srv_dev)) {
741*4882a593Smuzhiyun 		pr_err("Opening device '%s' on session %s failed, creating srv_dev failed, err: %ld\n",
742*4882a593Smuzhiyun 		       full_path, srv_sess->sessname, PTR_ERR(srv_dev));
743*4882a593Smuzhiyun 		ret = PTR_ERR(srv_dev);
744*4882a593Smuzhiyun 		goto rnbd_dev_close;
745*4882a593Smuzhiyun 	}
746*4882a593Smuzhiyun 
747*4882a593Smuzhiyun 	srv_sess_dev = rnbd_srv_create_set_sess_dev(srv_sess, open_msg,
748*4882a593Smuzhiyun 						     rnbd_dev, open_flags,
749*4882a593Smuzhiyun 						     srv_dev);
750*4882a593Smuzhiyun 	if (IS_ERR(srv_sess_dev)) {
751*4882a593Smuzhiyun 		pr_err("Opening device '%s' on session %s failed, creating sess_dev failed, err: %ld\n",
752*4882a593Smuzhiyun 		       full_path, srv_sess->sessname, PTR_ERR(srv_sess_dev));
753*4882a593Smuzhiyun 		ret = PTR_ERR(srv_sess_dev);
754*4882a593Smuzhiyun 		goto srv_dev_put;
755*4882a593Smuzhiyun 	}
756*4882a593Smuzhiyun 
757*4882a593Smuzhiyun 	/* Create the srv_dev sysfs files if they haven't been created yet. The
758*4882a593Smuzhiyun 	 * reason to delay the creation is not to create the sysfs files before
759*4882a593Smuzhiyun 	 * we are sure the device can be opened.
760*4882a593Smuzhiyun 	 */
761*4882a593Smuzhiyun 	mutex_lock(&srv_dev->lock);
762*4882a593Smuzhiyun 	if (!srv_dev->dev_kobj.state_in_sysfs) {
763*4882a593Smuzhiyun 		ret = rnbd_srv_create_dev_sysfs(srv_dev, rnbd_dev->bdev,
764*4882a593Smuzhiyun 						 rnbd_dev->name);
765*4882a593Smuzhiyun 		if (ret) {
766*4882a593Smuzhiyun 			mutex_unlock(&srv_dev->lock);
767*4882a593Smuzhiyun 			rnbd_srv_err(srv_sess_dev,
768*4882a593Smuzhiyun 				      "Opening device failed, failed to create device sysfs files, err: %d\n",
769*4882a593Smuzhiyun 				      ret);
770*4882a593Smuzhiyun 			goto free_srv_sess_dev;
771*4882a593Smuzhiyun 		}
772*4882a593Smuzhiyun 	}
773*4882a593Smuzhiyun 
774*4882a593Smuzhiyun 	ret = rnbd_srv_create_dev_session_sysfs(srv_sess_dev);
775*4882a593Smuzhiyun 	if (ret) {
776*4882a593Smuzhiyun 		mutex_unlock(&srv_dev->lock);
777*4882a593Smuzhiyun 		rnbd_srv_err(srv_sess_dev,
778*4882a593Smuzhiyun 			      "Opening device failed, failed to create dev client sysfs files, err: %d\n",
779*4882a593Smuzhiyun 			      ret);
780*4882a593Smuzhiyun 		goto free_srv_sess_dev;
781*4882a593Smuzhiyun 	}
782*4882a593Smuzhiyun 
783*4882a593Smuzhiyun 	list_add(&srv_sess_dev->dev_list, &srv_dev->sess_dev_list);
784*4882a593Smuzhiyun 	mutex_unlock(&srv_dev->lock);
785*4882a593Smuzhiyun 
786*4882a593Smuzhiyun 	list_add(&srv_sess_dev->sess_list, &srv_sess->sess_dev_list);
787*4882a593Smuzhiyun 
788*4882a593Smuzhiyun 	rnbd_srv_info(srv_sess_dev, "Opened device '%s'\n", srv_dev->id);
789*4882a593Smuzhiyun 
790*4882a593Smuzhiyun 	kfree(full_path);
791*4882a593Smuzhiyun 
792*4882a593Smuzhiyun fill_response:
793*4882a593Smuzhiyun 	rnbd_srv_fill_msg_open_rsp(rsp, srv_sess_dev);
794*4882a593Smuzhiyun 	mutex_unlock(&srv_sess->lock);
795*4882a593Smuzhiyun 	return 0;
796*4882a593Smuzhiyun 
797*4882a593Smuzhiyun free_srv_sess_dev:
798*4882a593Smuzhiyun 	xa_erase(&srv_sess->index_idr, srv_sess_dev->device_id);
799*4882a593Smuzhiyun 	synchronize_rcu();
800*4882a593Smuzhiyun 	kfree(srv_sess_dev);
801*4882a593Smuzhiyun srv_dev_put:
802*4882a593Smuzhiyun 	if (open_msg->access_mode != RNBD_ACCESS_RO) {
803*4882a593Smuzhiyun 		mutex_lock(&srv_dev->lock);
804*4882a593Smuzhiyun 		srv_dev->open_write_cnt--;
805*4882a593Smuzhiyun 		mutex_unlock(&srv_dev->lock);
806*4882a593Smuzhiyun 	}
807*4882a593Smuzhiyun 	rnbd_put_srv_dev(srv_dev);
808*4882a593Smuzhiyun rnbd_dev_close:
809*4882a593Smuzhiyun 	rnbd_dev_close(rnbd_dev);
810*4882a593Smuzhiyun free_path:
811*4882a593Smuzhiyun 	kfree(full_path);
812*4882a593Smuzhiyun reject:
813*4882a593Smuzhiyun 	mutex_unlock(&srv_sess->lock);
814*4882a593Smuzhiyun 	return ret;
815*4882a593Smuzhiyun }
816*4882a593Smuzhiyun 
817*4882a593Smuzhiyun static struct rtrs_srv_ctx *rtrs_ctx;
818*4882a593Smuzhiyun 
819*4882a593Smuzhiyun static struct rtrs_srv_ops rtrs_ops;
rnbd_srv_init_module(void)820*4882a593Smuzhiyun static int __init rnbd_srv_init_module(void)
821*4882a593Smuzhiyun {
822*4882a593Smuzhiyun 	int err;
823*4882a593Smuzhiyun 
824*4882a593Smuzhiyun 	BUILD_BUG_ON(sizeof(struct rnbd_msg_hdr) != 4);
825*4882a593Smuzhiyun 	BUILD_BUG_ON(sizeof(struct rnbd_msg_sess_info) != 36);
826*4882a593Smuzhiyun 	BUILD_BUG_ON(sizeof(struct rnbd_msg_sess_info_rsp) != 36);
827*4882a593Smuzhiyun 	BUILD_BUG_ON(sizeof(struct rnbd_msg_open) != 264);
828*4882a593Smuzhiyun 	BUILD_BUG_ON(sizeof(struct rnbd_msg_close) != 8);
829*4882a593Smuzhiyun 	BUILD_BUG_ON(sizeof(struct rnbd_msg_open_rsp) != 56);
830*4882a593Smuzhiyun 	rtrs_ops = (struct rtrs_srv_ops) {
831*4882a593Smuzhiyun 		.rdma_ev = rnbd_srv_rdma_ev,
832*4882a593Smuzhiyun 		.link_ev = rnbd_srv_link_ev,
833*4882a593Smuzhiyun 	};
834*4882a593Smuzhiyun 	rtrs_ctx = rtrs_srv_open(&rtrs_ops, port_nr);
835*4882a593Smuzhiyun 	if (IS_ERR(rtrs_ctx)) {
836*4882a593Smuzhiyun 		err = PTR_ERR(rtrs_ctx);
837*4882a593Smuzhiyun 		pr_err("rtrs_srv_open(), err: %d\n", err);
838*4882a593Smuzhiyun 		return err;
839*4882a593Smuzhiyun 	}
840*4882a593Smuzhiyun 
841*4882a593Smuzhiyun 	err = rnbd_srv_create_sysfs_files();
842*4882a593Smuzhiyun 	if (err) {
843*4882a593Smuzhiyun 		pr_err("rnbd_srv_create_sysfs_files(), err: %d\n", err);
844*4882a593Smuzhiyun 		rtrs_srv_close(rtrs_ctx);
845*4882a593Smuzhiyun 		return err;
846*4882a593Smuzhiyun 	}
847*4882a593Smuzhiyun 
848*4882a593Smuzhiyun 	return 0;
849*4882a593Smuzhiyun }
850*4882a593Smuzhiyun 
rnbd_srv_cleanup_module(void)851*4882a593Smuzhiyun static void __exit rnbd_srv_cleanup_module(void)
852*4882a593Smuzhiyun {
853*4882a593Smuzhiyun 	rtrs_srv_close(rtrs_ctx);
854*4882a593Smuzhiyun 	WARN_ON(!list_empty(&sess_list));
855*4882a593Smuzhiyun 	rnbd_srv_destroy_sysfs_files();
856*4882a593Smuzhiyun }
857*4882a593Smuzhiyun 
858*4882a593Smuzhiyun module_init(rnbd_srv_init_module);
859*4882a593Smuzhiyun module_exit(rnbd_srv_cleanup_module);
860