nbd.c 56.2 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6
/*
 * Network block device - make block devices work over TCP
 *
 * Note that you can not swap over this thing, yet. Seems to work but
 * deadlocks sometimes - you can not swap over TCP in general.
 * 
P
Pavel Machek 已提交
7
 * Copyright 1997-2000, 2008 Pavel Machek <pavel@ucw.cz>
L
Linus Torvalds 已提交
8 9
 * Parts copyright 2001 Steven Whitehouse <steve@chygwyn.com>
 *
10
 * This file is released under GPLv2 or later.
L
Linus Torvalds 已提交
11
 *
12
 * (part of code stolen from loop.c)
L
Linus Torvalds 已提交
13 14 15 16 17 18 19 20
 */

#include <linux/major.h>

#include <linux/blkdev.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/sched.h>
21
#include <linux/sched/mm.h>
L
Linus Torvalds 已提交
22 23 24 25 26 27
#include <linux/fs.h>
#include <linux/bio.h>
#include <linux/stat.h>
#include <linux/errno.h>
#include <linux/file.h>
#include <linux/ioctl.h>
28
#include <linux/mutex.h>
29 30 31
#include <linux/compiler.h>
#include <linux/err.h>
#include <linux/kernel.h>
32
#include <linux/slab.h>
L
Linus Torvalds 已提交
33
#include <net/sock.h>
34
#include <linux/net.h>
35
#include <linux/kthread.h>
M
Markus Pargmann 已提交
36
#include <linux/types.h>
M
Markus Pargmann 已提交
37
#include <linux/debugfs.h>
J
Josef Bacik 已提交
38
#include <linux/blk-mq.h>
L
Linus Torvalds 已提交
39

40
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
41 42 43
#include <asm/types.h>

#include <linux/nbd.h>
J
Josef Bacik 已提交
44 45
#include <linux/nbd-netlink.h>
#include <net/genetlink.h>
L
Linus Torvalds 已提交
46

47 48
static DEFINE_IDR(nbd_index_idr);
static DEFINE_MUTEX(nbd_index_mutex);
J
Josef Bacik 已提交
49
static int nbd_total_devices = 0;
50

J
Josef Bacik 已提交
51 52 53
struct nbd_sock {
	struct socket *sock;
	struct mutex tx_lock;
J
Josef Bacik 已提交
54 55
	struct request *pending;
	int sent;
56 57
	bool dead;
	int fallback_index;
58
	int cookie;
J
Josef Bacik 已提交
59 60
};

61 62 63 64 65 66
struct recv_thread_args {
	struct work_struct work;
	struct nbd_device *nbd;
	int index;
};

67 68 69 70 71
struct link_dead_args {
	struct work_struct work;
	int index;
};

J
Josef Bacik 已提交
72 73
#define NBD_TIMEDOUT			0
#define NBD_DISCONNECT_REQUESTED	1
J
Josef Bacik 已提交
74
#define NBD_DISCONNECTED		2
75
#define NBD_HAS_PID_FILE		3
J
Josef Bacik 已提交
76 77
#define NBD_HAS_CONFIG_REF		4
#define NBD_BOUND			5
78
#define NBD_DESTROY_ON_DISCONNECT	6
79
#define NBD_DISCONNECT_ON_CLOSE 	7
J
Josef Bacik 已提交
80

81
struct nbd_config {
M
Markus Pargmann 已提交
82
	u32 flags;
J
Josef Bacik 已提交
83
	unsigned long runtime_flags;
J
Josef Bacik 已提交
84
	u64 dead_conn_timeout;
85

86
	struct nbd_sock **socks;
J
Josef Bacik 已提交
87
	int num_connections;
J
Josef Bacik 已提交
88 89
	atomic_t live_connections;
	wait_queue_head_t conn_wait;
90

J
Josef Bacik 已提交
91 92
	atomic_t recv_threads;
	wait_queue_head_t recv_wq;
93
	loff_t blksize;
M
Markus Pargmann 已提交
94
	loff_t bytesize;
M
Markus Pargmann 已提交
95 96 97
#if IS_ENABLED(CONFIG_DEBUG_FS)
	struct dentry *dbg_dir;
#endif
98 99
};

100 101 102
struct nbd_device {
	struct blk_mq_tag_set tag_set;

J
Josef Bacik 已提交
103
	int index;
104
	refcount_t config_refs;
J
Josef Bacik 已提交
105
	refcount_t refs;
106 107 108 109
	struct nbd_config *config;
	struct mutex config_lock;
	struct gendisk *disk;

J
Josef Bacik 已提交
110
	struct list_head list;
111 112 113 114
	struct task_struct *task_recv;
	struct task_struct *task_setup;
};

115 116
#define NBD_CMD_REQUEUED	1

J
Josef Bacik 已提交
117 118
struct nbd_cmd {
	struct nbd_device *nbd;
119
	struct mutex lock;
120
	int index;
121
	int cookie;
122
	blk_status_t status;
123
	unsigned long flags;
124
	u32 cmd_cookie;
J
Josef Bacik 已提交
125 126
};

M
Markus Pargmann 已提交
127 128 129 130 131 132
#if IS_ENABLED(CONFIG_DEBUG_FS)
static struct dentry *nbd_dbg_dir;
#endif

#define nbd_name(nbd) ((nbd)->disk->disk_name)

133
#define NBD_MAGIC 0x68797548
L
Linus Torvalds 已提交
134

135
static unsigned int nbds_max = 16;
136
static int max_part = 16;
137
static struct workqueue_struct *recv_workqueue;
138
static int part_shift;
L
Linus Torvalds 已提交
139

J
Josef Bacik 已提交
140 141
static int nbd_dev_dbg_init(struct nbd_device *nbd);
static void nbd_dev_dbg_close(struct nbd_device *nbd);
142
static void nbd_config_put(struct nbd_device *nbd);
J
Josef Bacik 已提交
143
static void nbd_connect_reply(struct genl_info *info, int index);
J
Josef Bacik 已提交
144
static int nbd_genl_status(struct sk_buff *skb, struct genl_info *info);
145
static void nbd_dead_link_work(struct work_struct *work);
146
static void nbd_disconnect_and_put(struct nbd_device *nbd);
J
Josef Bacik 已提交
147

148
static inline struct device *nbd_to_dev(struct nbd_device *nbd)
L
Linus Torvalds 已提交
149
{
150
	return disk_to_dev(nbd->disk);
L
Linus Torvalds 已提交
151 152
}

153 154 155 156 157 158 159 160
static void nbd_requeue_cmd(struct nbd_cmd *cmd)
{
	struct request *req = blk_mq_rq_from_pdu(cmd);

	if (!test_and_set_bit(NBD_CMD_REQUEUED, &cmd->flags))
		blk_mq_requeue_request(req, true);
}

161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181
#define NBD_COOKIE_BITS 32

static u64 nbd_cmd_handle(struct nbd_cmd *cmd)
{
	struct request *req = blk_mq_rq_from_pdu(cmd);
	u32 tag = blk_mq_unique_tag(req);
	u64 cookie = cmd->cmd_cookie;

	return (cookie << NBD_COOKIE_BITS) | tag;
}

static u32 nbd_handle_to_tag(u64 handle)
{
	return (u32)handle;
}

static u32 nbd_handle_to_cookie(u64 handle)
{
	return (u32)(handle >> NBD_COOKIE_BITS);
}

L
Linus Torvalds 已提交
182 183 184 185 186 187
static const char *nbdcmd_to_ascii(int cmd)
{
	switch (cmd) {
	case  NBD_CMD_READ: return "read";
	case NBD_CMD_WRITE: return "write";
	case  NBD_CMD_DISC: return "disconnect";
A
Alex Bligh 已提交
188
	case NBD_CMD_FLUSH: return "flush";
P
Paul Clements 已提交
189
	case  NBD_CMD_TRIM: return "trim/discard";
L
Linus Torvalds 已提交
190 191 192 193
	}
	return "invalid";
}

194 195 196 197 198 199 200 201 202
static ssize_t pid_show(struct device *dev,
			struct device_attribute *attr, char *buf)
{
	struct gendisk *disk = dev_to_disk(dev);
	struct nbd_device *nbd = (struct nbd_device *)disk->private_data;

	return sprintf(buf, "%d\n", task_pid_nr(nbd->task_recv));
}

B
Bhumika Goyal 已提交
203
static const struct device_attribute pid_attr = {
204
	.attr = { .name = "pid", .mode = 0444},
205 206 207
	.show = pid_show,
};

J
Josef Bacik 已提交
208 209 210
static void nbd_dev_remove(struct nbd_device *nbd)
{
	struct gendisk *disk = nbd->disk;
J
Josef Bacik 已提交
211 212
	struct request_queue *q;

J
Josef Bacik 已提交
213
	if (disk) {
J
Josef Bacik 已提交
214
		q = disk->queue;
J
Josef Bacik 已提交
215
		del_gendisk(disk);
J
Josef Bacik 已提交
216
		blk_cleanup_queue(q);
J
Josef Bacik 已提交
217
		blk_mq_free_tag_set(&nbd->tag_set);
218
		disk->private_data = NULL;
J
Josef Bacik 已提交
219 220 221 222 223 224 225 226 227 228 229 230 231 232 233
		put_disk(disk);
	}
	kfree(nbd);
}

static void nbd_put(struct nbd_device *nbd)
{
	if (refcount_dec_and_mutex_lock(&nbd->refs,
					&nbd_index_mutex)) {
		idr_remove(&nbd_index_idr, nbd->index);
		mutex_unlock(&nbd_index_mutex);
		nbd_dev_remove(nbd);
	}
}

234 235 236 237 238 239 240 241
static int nbd_disconnected(struct nbd_config *config)
{
	return test_bit(NBD_DISCONNECTED, &config->runtime_flags) ||
		test_bit(NBD_DISCONNECT_REQUESTED, &config->runtime_flags);
}

static void nbd_mark_nsock_dead(struct nbd_device *nbd, struct nbd_sock *nsock,
				int notify)
242
{
243 244 245 246 247 248 249 250 251
	if (!nsock->dead && notify && !nbd_disconnected(nbd->config)) {
		struct link_dead_args *args;
		args = kmalloc(sizeof(struct link_dead_args), GFP_NOIO);
		if (args) {
			INIT_WORK(&args->work, nbd_dead_link_work);
			args->index = nbd->index;
			queue_work(system_wq, &args->work);
		}
	}
J
Josef Bacik 已提交
252
	if (!nsock->dead) {
253
		kernel_sock_shutdown(nsock->sock, SHUT_RDWR);
254 255 256 257 258 259 260 261 262
		if (atomic_dec_return(&nbd->config->live_connections) == 0) {
			if (test_and_clear_bit(NBD_DISCONNECT_REQUESTED,
					       &nbd->config->runtime_flags)) {
				set_bit(NBD_DISCONNECTED,
					&nbd->config->runtime_flags);
				dev_info(nbd_to_dev(nbd),
					"Disconnected due to user request.\n");
			}
		}
J
Josef Bacik 已提交
263
	}
264 265 266 267 268
	nsock->dead = true;
	nsock->pending = NULL;
	nsock->sent = 0;
}

269
static void nbd_size_clear(struct nbd_device *nbd)
270
{
271 272 273 274
	if (nbd->config->bytesize) {
		set_capacity(nbd->disk, 0);
		kobject_uevent(&nbd_to_dev(nbd)->kobj, KOBJ_CHANGE);
	}
275 276
}

277
static void nbd_size_update(struct nbd_device *nbd)
278
{
279
	struct nbd_config *config = nbd->config;
280 281
	struct block_device *bdev = bdget_disk(nbd->disk, 0);

282 283
	if (config->flags & NBD_FLAG_SEND_TRIM) {
		nbd->disk->queue->limits.discard_granularity = config->blksize;
284
		nbd->disk->queue->limits.discard_alignment = config->blksize;
285 286
		blk_queue_max_discard_sectors(nbd->disk->queue, UINT_MAX);
	}
287 288 289
	blk_queue_logical_block_size(nbd->disk->queue, config->blksize);
	blk_queue_physical_block_size(nbd->disk->queue, config->blksize);
	set_capacity(nbd->disk, config->bytesize >> 9);
290 291 292 293 294 295 296
	if (bdev) {
		if (bdev->bd_disk)
			bd_set_size(bdev, config->bytesize);
		else
			bdev->bd_invalidated = 1;
		bdput(bdev);
	}
297 298 299
	kobject_uevent(&nbd_to_dev(nbd)->kobj, KOBJ_CHANGE);
}

300 301
static void nbd_size_set(struct nbd_device *nbd, loff_t blocksize,
			 loff_t nr_blocks)
302
{
303 304 305
	struct nbd_config *config = nbd->config;
	config->blksize = blocksize;
	config->bytesize = blocksize * nr_blocks;
J
Josef Bacik 已提交
306 307
	if (nbd->task_recv != NULL)
		nbd_size_update(nbd);
308 309
}

C
Christoph Hellwig 已提交
310
static void nbd_complete_rq(struct request *req)
L
Linus Torvalds 已提交
311
{
C
Christoph Hellwig 已提交
312
	struct nbd_cmd *cmd = blk_mq_rq_to_pdu(req);
L
Linus Torvalds 已提交
313

314
	dev_dbg(nbd_to_dev(cmd->nbd), "request %p: %s\n", req,
C
Christoph Hellwig 已提交
315
		cmd->status ? "failed" : "done");
L
Linus Torvalds 已提交
316

C
Christoph Hellwig 已提交
317
	blk_mq_end_request(req, cmd->status);
L
Linus Torvalds 已提交
318 319
}

320 321 322
/*
 * Forcibly shutdown the socket causing all listeners to error
 */
323
static void sock_shutdown(struct nbd_device *nbd)
324
{
325
	struct nbd_config *config = nbd->config;
J
Josef Bacik 已提交
326
	int i;
M
Markus Pargmann 已提交
327

328
	if (config->num_connections == 0)
J
Josef Bacik 已提交
329
		return;
330
	if (test_and_set_bit(NBD_DISCONNECTED, &config->runtime_flags))
M
Markus Pargmann 已提交
331
		return;
M
Markus Pargmann 已提交
332

333 334
	for (i = 0; i < config->num_connections; i++) {
		struct nbd_sock *nsock = config->socks[i];
J
Josef Bacik 已提交
335
		mutex_lock(&nsock->tx_lock);
336
		nbd_mark_nsock_dead(nbd, nsock, 0);
J
Josef Bacik 已提交
337 338 339
		mutex_unlock(&nsock->tx_lock);
	}
	dev_warn(disk_to_dev(nbd->disk), "shutting down sockets\n");
340 341
}

342 343
static enum blk_eh_timer_return nbd_xmit_timeout(struct request *req,
						 bool reserved)
344
{
345 346
	struct nbd_cmd *cmd = blk_mq_rq_to_pdu(req);
	struct nbd_device *nbd = cmd->nbd;
347 348 349
	struct nbd_config *config;

	if (!refcount_inc_not_zero(&nbd->config_refs)) {
350
		cmd->status = BLK_STS_TIMEOUT;
351
		goto done;
352 353
	}
	config = nbd->config;
M
Markus Pargmann 已提交
354

355 356 357
	if (!mutex_trylock(&cmd->lock))
		return BLK_EH_RESET_TIMER;

358
	if (config->num_connections > 1) {
359
		dev_err_ratelimited(nbd_to_dev(nbd),
360 361 362
				    "Connection timed out, retrying (%d/%d alive)\n",
				    atomic_read(&config->live_connections),
				    config->num_connections);
363 364 365 366
		/*
		 * Hooray we have more connections, requeue this IO, the submit
		 * path will put it on a real connection.
		 */
367 368
		if (config->socks && config->num_connections > 1) {
			if (cmd->index < config->num_connections) {
369
				struct nbd_sock *nsock =
370
					config->socks[cmd->index];
371
				mutex_lock(&nsock->tx_lock);
372 373 374 375 376 377 378 379
				/* We can have multiple outstanding requests, so
				 * we don't want to mark the nsock dead if we've
				 * already reconnected with a new socket, so
				 * only mark it dead if its the same socket we
				 * were sent out on.
				 */
				if (cmd->cookie == nsock->cookie)
					nbd_mark_nsock_dead(nbd, nsock, 1);
380 381
				mutex_unlock(&nsock->tx_lock);
			}
382
			mutex_unlock(&cmd->lock);
383
			nbd_requeue_cmd(cmd);
384
			nbd_config_put(nbd);
385
			return BLK_EH_DONE;
386 387 388 389 390
		}
	} else {
		dev_err_ratelimited(nbd_to_dev(nbd),
				    "Connection timed out\n");
	}
391
	set_bit(NBD_TIMEDOUT, &config->runtime_flags);
392
	cmd->status = BLK_STS_IOERR;
393
	mutex_unlock(&cmd->lock);
J
Josef Bacik 已提交
394
	sock_shutdown(nbd);
395
	nbd_config_put(nbd);
396 397 398
done:
	blk_mq_complete_request(req);
	return BLK_EH_DONE;
399 400
}

L
Linus Torvalds 已提交
401 402 403
/*
 *  Send or receive packet.
 */
A
Al Viro 已提交
404
static int sock_xmit(struct nbd_device *nbd, int index, int send,
J
Josef Bacik 已提交
405
		     struct iov_iter *iter, int msg_flags, int *sent)
L
Linus Torvalds 已提交
406
{
407 408
	struct nbd_config *config = nbd->config;
	struct socket *sock = config->socks[index]->sock;
L
Linus Torvalds 已提交
409 410
	int result;
	struct msghdr msg;
411
	unsigned int noreclaim_flag;
L
Linus Torvalds 已提交
412

413
	if (unlikely(!sock)) {
414
		dev_err_ratelimited(disk_to_dev(nbd->disk),
415 416
			"Attempted %s on closed socket in sock_xmit\n",
			(send ? "send" : "recv"));
417 418 419
		return -EINVAL;
	}

A
Al Viro 已提交
420
	msg.msg_iter = *iter;
421

422
	noreclaim_flag = memalloc_noreclaim_save();
L
Linus Torvalds 已提交
423
	do {
424
		sock->sk->sk_allocation = GFP_NOIO | __GFP_MEMALLOC;
L
Linus Torvalds 已提交
425 426 427 428 429 430
		msg.msg_name = NULL;
		msg.msg_namelen = 0;
		msg.msg_control = NULL;
		msg.msg_controllen = 0;
		msg.msg_flags = msg_flags | MSG_NOSIGNAL;

M
Markus Pargmann 已提交
431
		if (send)
432
			result = sock_sendmsg(sock, &msg);
M
Markus Pargmann 已提交
433
		else
434
			result = sock_recvmsg(sock, &msg, msg.msg_flags);
L
Linus Torvalds 已提交
435 436 437 438 439 440

		if (result <= 0) {
			if (result == 0)
				result = -EPIPE; /* short read */
			break;
		}
J
Josef Bacik 已提交
441 442
		if (sent)
			*sent += result;
443
	} while (msg_data_left(&msg));
L
Linus Torvalds 已提交
444

445
	memalloc_noreclaim_restore(noreclaim_flag);
L
Linus Torvalds 已提交
446 447 448 449

	return result;
}

450 451 452 453 454 455 456 457 458
/*
 * Different settings for sk->sk_sndtimeo can result in different return values
 * if there is a signal pending when we enter sendmsg, because reasons?
 */
static inline int was_interrupted(int result)
{
	return result == -ERESTARTSYS || result == -EINTR;
}

459
/* always call with the tx_lock held */
J
Josef Bacik 已提交
460
static int nbd_send_cmd(struct nbd_device *nbd, struct nbd_cmd *cmd, int index)
L
Linus Torvalds 已提交
461
{
J
Josef Bacik 已提交
462
	struct request *req = blk_mq_rq_from_pdu(cmd);
463 464
	struct nbd_config *config = nbd->config;
	struct nbd_sock *nsock = config->socks[index];
465
	int result;
A
Al Viro 已提交
466 467 468
	struct nbd_request request = {.magic = htonl(NBD_REQUEST_MAGIC)};
	struct kvec iov = {.iov_base = &request, .iov_len = sizeof(request)};
	struct iov_iter from;
469
	unsigned long size = blk_rq_bytes(req);
470
	struct bio *bio;
471
	u64 handle;
C
Christoph Hellwig 已提交
472
	u32 type;
S
Shaun McDowell 已提交
473
	u32 nbd_cmd_flags = 0;
J
Josef Bacik 已提交
474
	int sent = nsock->sent, skip = 0;
C
Christoph Hellwig 已提交
475

A
Al Viro 已提交
476 477
	iov_iter_kvec(&from, WRITE | ITER_KVEC, &iov, 1, sizeof(request));

478 479
	switch (req_op(req)) {
	case REQ_OP_DISCARD:
C
Christoph Hellwig 已提交
480
		type = NBD_CMD_TRIM;
481 482
		break;
	case REQ_OP_FLUSH:
C
Christoph Hellwig 已提交
483
		type = NBD_CMD_FLUSH;
484 485
		break;
	case REQ_OP_WRITE:
C
Christoph Hellwig 已提交
486
		type = NBD_CMD_WRITE;
487 488
		break;
	case REQ_OP_READ:
C
Christoph Hellwig 已提交
489
		type = NBD_CMD_READ;
490 491 492 493
		break;
	default:
		return -EIO;
	}
L
Linus Torvalds 已提交
494

495
	if (rq_data_dir(req) == WRITE &&
496
	    (config->flags & NBD_FLAG_READ_ONLY)) {
497 498 499 500 501
		dev_err_ratelimited(disk_to_dev(nbd->disk),
				    "Write on read-only\n");
		return -EIO;
	}

S
Shaun McDowell 已提交
502 503 504
	if (req->cmd_flags & REQ_FUA)
		nbd_cmd_flags |= NBD_CMD_FLAG_FUA;

J
Josef Bacik 已提交
505 506 507 508 509 510 511 512 513 514
	/* We did a partial send previously, and we at least sent the whole
	 * request struct, so just go and send the rest of the pages in the
	 * request.
	 */
	if (sent) {
		if (sent >= sizeof(request)) {
			skip = sent - sizeof(request);
			goto send_pages;
		}
		iov_iter_advance(&from, sent);
515 516
	} else {
		cmd->cmd_cookie++;
J
Josef Bacik 已提交
517
	}
518
	cmd->index = index;
519
	cmd->cookie = nsock->cookie;
S
Shaun McDowell 已提交
520
	request.type = htonl(type | nbd_cmd_flags);
J
Josef Bacik 已提交
521
	if (type != NBD_CMD_FLUSH) {
A
Alex Bligh 已提交
522 523 524
		request.from = cpu_to_be64((u64)blk_rq_pos(req) << 9);
		request.len = htonl(size);
	}
525 526
	handle = nbd_cmd_handle(cmd);
	memcpy(request.handle, &handle, sizeof(handle));
L
Linus Torvalds 已提交
527

528
	dev_dbg(nbd_to_dev(nbd), "request %p: sending control (%s@%llu,%uB)\n",
529
		req, nbdcmd_to_ascii(type),
530
		(unsigned long long)blk_rq_pos(req) << 9, blk_rq_bytes(req));
A
Al Viro 已提交
531
	result = sock_xmit(nbd, index, 1, &from,
J
Josef Bacik 已提交
532
			(type == NBD_CMD_WRITE) ? MSG_MORE : 0, &sent);
L
Linus Torvalds 已提交
533
	if (result <= 0) {
534
		if (was_interrupted(result)) {
J
Josef Bacik 已提交
535 536 537 538 539 540 541 542 543
			/* If we havne't sent anything we can just return BUSY,
			 * however if we have sent something we need to make
			 * sure we only allow this req to be sent until we are
			 * completely done.
			 */
			if (sent) {
				nsock->pending = req;
				nsock->sent = sent;
			}
544
			set_bit(NBD_CMD_REQUEUED, &cmd->flags);
545
			return BLK_STS_RESOURCE;
J
Josef Bacik 已提交
546
		}
547
		dev_err_ratelimited(disk_to_dev(nbd->disk),
548
			"Send control failed (result %d)\n", result);
549
		return -EAGAIN;
L
Linus Torvalds 已提交
550
	}
J
Josef Bacik 已提交
551
send_pages:
552
	if (type != NBD_CMD_WRITE)
J
Josef Bacik 已提交
553
		goto out;
554 555 556 557 558

	bio = req->bio;
	while (bio) {
		struct bio *next = bio->bi_next;
		struct bvec_iter iter;
559
		struct bio_vec bvec;
560 561 562

		bio_for_each_segment(bvec, bio, iter) {
			bool is_last = !next && bio_iter_last(bvec, iter);
563
			int flags = is_last ? 0 : MSG_MORE;
564

565
			dev_dbg(nbd_to_dev(nbd), "request %p: sending %d bytes data\n",
566
				req, bvec.bv_len);
A
Al Viro 已提交
567 568
			iov_iter_bvec(&from, ITER_BVEC | WRITE,
				      &bvec, 1, bvec.bv_len);
J
Josef Bacik 已提交
569 570 571 572 573 574 575 576 577
			if (skip) {
				if (skip >= iov_iter_count(&from)) {
					skip -= iov_iter_count(&from);
					continue;
				}
				iov_iter_advance(&from, skip);
				skip = 0;
			}
			result = sock_xmit(nbd, index, 1, &from, flags, &sent);
578
			if (result <= 0) {
579
				if (was_interrupted(result)) {
J
Josef Bacik 已提交
580 581 582 583 584 585
					/* We've already sent the header, we
					 * have no choice but to set pending and
					 * return BUSY.
					 */
					nsock->pending = req;
					nsock->sent = sent;
586
					set_bit(NBD_CMD_REQUEUED, &cmd->flags);
587
					return BLK_STS_RESOURCE;
J
Josef Bacik 已提交
588
				}
589
				dev_err(disk_to_dev(nbd->disk),
590 591
					"Send data failed (result %d)\n",
					result);
592
				return -EAGAIN;
593
			}
594 595 596 597 598 599 600 601
			/*
			 * The completion might already have come in,
			 * so break for the last one instead of letting
			 * the iterator do it. This prevents use-after-free
			 * of the bio.
			 */
			if (is_last)
				break;
L
Linus Torvalds 已提交
602
		}
603
		bio = next;
L
Linus Torvalds 已提交
604
	}
J
Josef Bacik 已提交
605 606 607
out:
	nsock->pending = NULL;
	nsock->sent = 0;
L
Linus Torvalds 已提交
608 609 610 611
	return 0;
}

/* NULL returned = something went wrong, inform userspace */
J
Josef Bacik 已提交
612
static struct nbd_cmd *nbd_read_stat(struct nbd_device *nbd, int index)
L
Linus Torvalds 已提交
613
{
614
	struct nbd_config *config = nbd->config;
L
Linus Torvalds 已提交
615 616
	int result;
	struct nbd_reply reply;
J
Josef Bacik 已提交
617 618
	struct nbd_cmd *cmd;
	struct request *req = NULL;
619
	u64 handle;
J
Josef Bacik 已提交
620
	u16 hwq;
J
Josef Bacik 已提交
621
	u32 tag;
A
Al Viro 已提交
622 623
	struct kvec iov = {.iov_base = &reply, .iov_len = sizeof(reply)};
	struct iov_iter to;
624
	int ret = 0;
L
Linus Torvalds 已提交
625 626

	reply.magic = 0;
A
Al Viro 已提交
627
	iov_iter_kvec(&to, READ | ITER_KVEC, &iov, 1, sizeof(reply));
J
Josef Bacik 已提交
628
	result = sock_xmit(nbd, index, 0, &to, MSG_WAITALL, NULL);
L
Linus Torvalds 已提交
629
	if (result <= 0) {
630
		if (!nbd_disconnected(config))
J
Josef Bacik 已提交
631 632
			dev_err(disk_to_dev(nbd->disk),
				"Receive control failed (result %d)\n", result);
633
		return ERR_PTR(result);
L
Linus Torvalds 已提交
634
	}
635 636

	if (ntohl(reply.magic) != NBD_REPLY_MAGIC) {
637
		dev_err(disk_to_dev(nbd->disk), "Wrong magic (0x%lx)\n",
638
				(unsigned long)ntohl(reply.magic));
639
		return ERR_PTR(-EPROTO);
640 641
	}

642 643
	memcpy(&handle, reply.handle, sizeof(handle));
	tag = nbd_handle_to_tag(handle);
J
Josef Bacik 已提交
644 645 646 647 648 649 650 651
	hwq = blk_mq_unique_tag_to_hwq(tag);
	if (hwq < nbd->tag_set.nr_hw_queues)
		req = blk_mq_tag_to_rq(nbd->tag_set.tags[hwq],
				       blk_mq_unique_tag_to_tag(tag));
	if (!req || !blk_mq_request_started(req)) {
		dev_err(disk_to_dev(nbd->disk), "Unexpected reply (%d) %p\n",
			tag, req);
		return ERR_PTR(-ENOENT);
L
Linus Torvalds 已提交
652
	}
J
Josef Bacik 已提交
653
	cmd = blk_mq_rq_to_pdu(req);
654 655 656 657 658 659 660 661 662 663 664 665 666 667

	mutex_lock(&cmd->lock);
	if (cmd->cmd_cookie != nbd_handle_to_cookie(handle)) {
		dev_err(disk_to_dev(nbd->disk), "Double reply on req %p, cmd_cookie %u, handle cookie %u\n",
			req, cmd->cmd_cookie, nbd_handle_to_cookie(handle));
		ret = -ENOENT;
		goto out;
	}
	if (test_bit(NBD_CMD_REQUEUED, &cmd->flags)) {
		dev_err(disk_to_dev(nbd->disk), "Raced with timeout on req %p\n",
			req);
		ret = -ENOENT;
		goto out;
	}
L
Linus Torvalds 已提交
668
	if (ntohl(reply.error)) {
669
		dev_err(disk_to_dev(nbd->disk), "Other side returned error (%d)\n",
670
			ntohl(reply.error));
671
		cmd->status = BLK_STS_IOERR;
672
		goto out;
L
Linus Torvalds 已提交
673 674
	}

675
	dev_dbg(nbd_to_dev(nbd), "request %p: got reply\n", req);
C
Christoph Hellwig 已提交
676
	if (rq_data_dir(req) != WRITE) {
677
		struct req_iterator iter;
678
		struct bio_vec bvec;
679 680

		rq_for_each_segment(bvec, req, iter) {
A
Al Viro 已提交
681 682
			iov_iter_bvec(&to, ITER_BVEC | READ,
				      &bvec, 1, bvec.bv_len);
J
Josef Bacik 已提交
683
			result = sock_xmit(nbd, index, 0, &to, MSG_WAITALL, NULL);
684
			if (result <= 0) {
685
				dev_err(disk_to_dev(nbd->disk), "Receive data failed (result %d)\n",
686
					result);
687 688 689 690 691 692 693
				/*
				 * If we've disconnected or we only have 1
				 * connection then we need to make sure we
				 * complete this request, otherwise error out
				 * and let the timeout stuff handle resubmitting
				 * this request onto another connection.
				 */
694 695
				if (nbd_disconnected(config) ||
				    config->num_connections <= 1) {
696
					cmd->status = BLK_STS_IOERR;
697
					goto out;
698
				}
699 700
				ret = -EIO;
				goto out;
701
			}
702
			dev_dbg(nbd_to_dev(nbd), "request %p: got %d bytes data\n",
703
				req, bvec.bv_len);
L
Linus Torvalds 已提交
704 705
		}
	}
706 707 708
out:
	mutex_unlock(&cmd->lock);
	return ret ? ERR_PTR(ret) : cmd;
L
Linus Torvalds 已提交
709 710
}

J
Josef Bacik 已提交
711
static void recv_work(struct work_struct *work)
L
Linus Torvalds 已提交
712
{
J
Josef Bacik 已提交
713 714 715 716
	struct recv_thread_args *args = container_of(work,
						     struct recv_thread_args,
						     work);
	struct nbd_device *nbd = args->nbd;
717
	struct nbd_config *config = nbd->config;
J
Josef Bacik 已提交
718
	struct nbd_cmd *cmd;
L
Linus Torvalds 已提交
719

720
	while (1) {
J
Josef Bacik 已提交
721
		cmd = nbd_read_stat(nbd, args->index);
J
Josef Bacik 已提交
722
		if (IS_ERR(cmd)) {
723
			struct nbd_sock *nsock = config->socks[args->index];
724 725

			mutex_lock(&nsock->tx_lock);
726
			nbd_mark_nsock_dead(nbd, nsock, 1);
727
			mutex_unlock(&nsock->tx_lock);
728 729 730
			break;
		}

731
		blk_mq_complete_request(blk_mq_rq_from_pdu(cmd));
732
	}
733 734 735 736
	atomic_dec(&config->recv_threads);
	wake_up(&config->recv_wq);
	nbd_config_put(nbd);
	kfree(args);
L
Linus Torvalds 已提交
737 738
}

J
Josef Bacik 已提交
739
static void nbd_clear_req(struct request *req, void *data, bool reserved)
L
Linus Torvalds 已提交
740
{
741
	struct nbd_cmd *cmd = blk_mq_rq_to_pdu(req);
L
Linus Torvalds 已提交
742

743
	cmd->status = BLK_STS_IOERR;
744
	blk_mq_complete_request(req);
J
Josef Bacik 已提交
745 746 747 748
}

static void nbd_clear_que(struct nbd_device *nbd)
{
749
	blk_mq_quiesce_queue(nbd->disk->queue);
J
Josef Bacik 已提交
750
	blk_mq_tagset_busy_iter(&nbd->tag_set, nbd_clear_req, NULL);
751
	blk_mq_unquiesce_queue(nbd->disk->queue);
752
	dev_dbg(disk_to_dev(nbd->disk), "queue cleared\n");
L
Linus Torvalds 已提交
753 754
}

755 756
static int find_fallback(struct nbd_device *nbd, int index)
{
757
	struct nbd_config *config = nbd->config;
758
	int new_index = -1;
759
	struct nbd_sock *nsock = config->socks[index];
760 761
	int fallback = nsock->fallback_index;

762
	if (test_bit(NBD_DISCONNECTED, &config->runtime_flags))
763 764
		return new_index;

765
	if (config->num_connections <= 1) {
766 767 768 769 770
		dev_err_ratelimited(disk_to_dev(nbd->disk),
				    "Attempted send on invalid socket\n");
		return new_index;
	}

771 772
	if (fallback >= 0 && fallback < config->num_connections &&
	    !config->socks[fallback]->dead)
773 774 775
		return fallback;

	if (nsock->fallback_index < 0 ||
776 777
	    nsock->fallback_index >= config->num_connections ||
	    config->socks[nsock->fallback_index]->dead) {
778
		int i;
779
		for (i = 0; i < config->num_connections; i++) {
780 781
			if (i == index)
				continue;
782
			if (!config->socks[i]->dead) {
783 784 785 786 787 788 789 790 791 792 793 794 795 796
				new_index = i;
				break;
			}
		}
		nsock->fallback_index = new_index;
		if (new_index < 0) {
			dev_err_ratelimited(disk_to_dev(nbd->disk),
					    "Dead connection, failed to find a fallback\n");
			return new_index;
		}
	}
	new_index = nsock->fallback_index;
	return new_index;
}
797

J
Josef Bacik 已提交
798 799 800 801 802 803 804
static int wait_for_reconnect(struct nbd_device *nbd)
{
	struct nbd_config *config = nbd->config;
	if (!config->dead_conn_timeout)
		return 0;
	if (test_bit(NBD_DISCONNECTED, &config->runtime_flags))
		return 0;
805 806 807
	return wait_event_timeout(config->conn_wait,
				  atomic_read(&config->live_connections) > 0,
				  config->dead_conn_timeout) > 0;
J
Josef Bacik 已提交
808 809
}

J
Josef Bacik 已提交
810
static int nbd_handle_cmd(struct nbd_cmd *cmd, int index)
811
{
J
Josef Bacik 已提交
812 813
	struct request *req = blk_mq_rq_from_pdu(cmd);
	struct nbd_device *nbd = cmd->nbd;
814
	struct nbd_config *config;
J
Josef Bacik 已提交
815
	struct nbd_sock *nsock;
J
Josef Bacik 已提交
816
	int ret;
J
Josef Bacik 已提交
817

818 819 820
	if (!refcount_inc_not_zero(&nbd->config_refs)) {
		dev_err_ratelimited(disk_to_dev(nbd->disk),
				    "Socks array is empty\n");
821
		blk_mq_start_request(req);
822 823 824 825 826
		return -EINVAL;
	}
	config = nbd->config;

	if (index >= config->num_connections) {
827 828
		dev_err_ratelimited(disk_to_dev(nbd->disk),
				    "Attempted send on invalid socket\n");
829
		nbd_config_put(nbd);
830
		blk_mq_start_request(req);
J
Josef Bacik 已提交
831
		return -EINVAL;
J
Josef Bacik 已提交
832
	}
833
	cmd->status = BLK_STS_OK;
834
again:
835
	nsock = config->socks[index];
J
Josef Bacik 已提交
836
	mutex_lock(&nsock->tx_lock);
837
	if (nsock->dead) {
J
Josef Bacik 已提交
838
		int old_index = index;
839
		index = find_fallback(nbd, index);
J
Josef Bacik 已提交
840
		mutex_unlock(&nsock->tx_lock);
841
		if (index < 0) {
J
Josef Bacik 已提交
842 843 844 845 846 847 848 849 850 851 852 853
			if (wait_for_reconnect(nbd)) {
				index = old_index;
				goto again;
			}
			/* All the sockets should already be down at this point,
			 * we just want to make sure that DISCONNECTED is set so
			 * any requests that come in that were queue'ed waiting
			 * for the reconnect timer don't trigger the timer again
			 * and instead just error out.
			 */
			sock_shutdown(nbd);
			nbd_config_put(nbd);
854
			blk_mq_start_request(req);
J
Josef Bacik 已提交
855
			return -EIO;
856
		}
857
		goto again;
858 859
	}

J
Josef Bacik 已提交
860 861 862 863 864
	/* Handle the case that we have a pending request that was partially
	 * transmitted that _has_ to be serviced first.  We need to call requeue
	 * here so that it gets put _after_ the request that is already on the
	 * dispatch list.
	 */
865
	blk_mq_start_request(req);
J
Josef Bacik 已提交
866
	if (unlikely(nsock->pending && nsock->pending != req)) {
867
		nbd_requeue_cmd(cmd);
J
Josef Bacik 已提交
868 869
		ret = 0;
		goto out;
870
	}
871 872 873 874
	/*
	 * Some failures are related to the link going down, so anything that
	 * returns EAGAIN can be retried on a different socket.
	 */
J
Josef Bacik 已提交
875
	ret = nbd_send_cmd(nbd, cmd, index);
876 877
	if (ret == -EAGAIN) {
		dev_err_ratelimited(disk_to_dev(nbd->disk),
878
				    "Request send failed, requeueing\n");
879
		nbd_mark_nsock_dead(nbd, nsock, 1);
880
		nbd_requeue_cmd(cmd);
881
		ret = 0;
882
	}
J
Josef Bacik 已提交
883
out:
J
Josef Bacik 已提交
884
	mutex_unlock(&nsock->tx_lock);
885
	nbd_config_put(nbd);
J
Josef Bacik 已提交
886
	return ret;
887 888
}

889
static blk_status_t nbd_queue_rq(struct blk_mq_hw_ctx *hctx,
J
Josef Bacik 已提交
890
			const struct blk_mq_queue_data *bd)
L
Linus Torvalds 已提交
891
{
J
Josef Bacik 已提交
892
	struct nbd_cmd *cmd = blk_mq_rq_to_pdu(bd->rq);
J
Josef Bacik 已提交
893
	int ret;
L
Linus Torvalds 已提交
894

J
Josef Bacik 已提交
895 896 897 898 899 900 901 902 903
	/*
	 * Since we look at the bio's to send the request over the network we
	 * need to make sure the completion work doesn't mark this request done
	 * before we are done doing our send.  This keeps us from dereferencing
	 * freed data if we have particularly fast completions (ie we get the
	 * completion before we exit sock_xmit on the last bvec) or in the case
	 * that the server is misbehaving (or there was an error) before we're
	 * done sending everything over the wire.
	 */
904
	mutex_lock(&cmd->lock);
905
	clear_bit(NBD_CMD_REQUEUED, &cmd->flags);
J
Josef Bacik 已提交
906 907 908 909 910 911 912

	/* We can be called directly from the user space process, which means we
	 * could possibly have signals pending so our sendmsg will fail.  In
	 * this case we need to return that we are busy, otherwise error out as
	 * appropriate.
	 */
	ret = nbd_handle_cmd(cmd, hctx->queue_num);
J
Josef Bacik 已提交
913 914 915 916
	if (ret < 0)
		ret = BLK_STS_IOERR;
	else if (!ret)
		ret = BLK_STS_OK;
917
	mutex_unlock(&cmd->lock);
J
Josef Bacik 已提交
918

J
Josef Bacik 已提交
919
	return ret;
L
Linus Torvalds 已提交
920 921
}

J
Josef Bacik 已提交
922 923
static int nbd_add_socket(struct nbd_device *nbd, unsigned long arg,
			  bool netlink)
M
Markus Pargmann 已提交
924
{
925
	struct nbd_config *config = nbd->config;
J
Josef Bacik 已提交
926
	struct socket *sock;
J
Josef Bacik 已提交
927 928
	struct nbd_sock **socks;
	struct nbd_sock *nsock;
J
Josef Bacik 已提交
929 930 931 932 933
	int err;

	sock = sockfd_lookup(arg, &err);
	if (!sock)
		return err;
M
Markus Pargmann 已提交
934

J
Josef Bacik 已提交
935 936
	if (!netlink && !nbd->task_setup &&
	    !test_bit(NBD_BOUND, &config->runtime_flags))
J
Josef Bacik 已提交
937
		nbd->task_setup = current;
J
Josef Bacik 已提交
938 939 940 941

	if (!netlink &&
	    (nbd->task_setup != current ||
	     test_bit(NBD_BOUND, &config->runtime_flags))) {
J
Josef Bacik 已提交
942 943
		dev_err(disk_to_dev(nbd->disk),
			"Device being setup by another task");
J
Josef Bacik 已提交
944
		sockfd_put(sock);
J
Josef Bacik 已提交
945
		return -EBUSY;
M
Markus Pargmann 已提交
946 947
	}

948
	socks = krealloc(config->socks, (config->num_connections + 1) *
J
Josef Bacik 已提交
949
			 sizeof(struct nbd_sock *), GFP_KERNEL);
J
Josef Bacik 已提交
950 951
	if (!socks) {
		sockfd_put(sock);
J
Josef Bacik 已提交
952
		return -ENOMEM;
J
Josef Bacik 已提交
953
	}
J
Josef Bacik 已提交
954
	nsock = kzalloc(sizeof(struct nbd_sock), GFP_KERNEL);
J
Josef Bacik 已提交
955 956
	if (!nsock) {
		sockfd_put(sock);
J
Josef Bacik 已提交
957
		return -ENOMEM;
J
Josef Bacik 已提交
958
	}
J
Josef Bacik 已提交
959

960
	config->socks = socks;
M
Markus Pargmann 已提交
961

962 963
	nsock->fallback_index = -1;
	nsock->dead = false;
J
Josef Bacik 已提交
964 965
	mutex_init(&nsock->tx_lock);
	nsock->sock = sock;
J
Josef Bacik 已提交
966 967
	nsock->pending = NULL;
	nsock->sent = 0;
968
	nsock->cookie = 0;
969
	socks[config->num_connections++] = nsock;
J
Josef Bacik 已提交
970
	atomic_inc(&config->live_connections);
M
Markus Pargmann 已提交
971

J
Josef Bacik 已提交
972
	return 0;
M
Markus Pargmann 已提交
973 974
}

975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004
static int nbd_reconnect_socket(struct nbd_device *nbd, unsigned long arg)
{
	struct nbd_config *config = nbd->config;
	struct socket *sock, *old;
	struct recv_thread_args *args;
	int i;
	int err;

	sock = sockfd_lookup(arg, &err);
	if (!sock)
		return err;

	args = kzalloc(sizeof(*args), GFP_KERNEL);
	if (!args) {
		sockfd_put(sock);
		return -ENOMEM;
	}

	for (i = 0; i < config->num_connections; i++) {
		struct nbd_sock *nsock = config->socks[i];

		if (!nsock->dead)
			continue;

		mutex_lock(&nsock->tx_lock);
		if (!nsock->dead) {
			mutex_unlock(&nsock->tx_lock);
			continue;
		}
		sk_set_memalloc(sock->sk);
1005 1006
		if (nbd->tag_set.timeout)
			sock->sk->sk_sndtimeo = nbd->tag_set.timeout;
1007 1008 1009 1010 1011 1012 1013 1014 1015
		atomic_inc(&config->recv_threads);
		refcount_inc(&nbd->config_refs);
		old = nsock->sock;
		nsock->fallback_index = -1;
		nsock->sock = sock;
		nsock->dead = false;
		INIT_WORK(&args->work, recv_work);
		args->index = i;
		args->nbd = nbd;
1016
		nsock->cookie++;
1017 1018 1019
		mutex_unlock(&nsock->tx_lock);
		sockfd_put(old);

1020 1021
		clear_bit(NBD_DISCONNECTED, &config->runtime_flags);

1022 1023 1024 1025
		/* We take the tx_mutex in an error path in the recv_work, so we
		 * need to queue_work outside of the tx_mutex.
		 */
		queue_work(recv_workqueue, &args->work);
J
Josef Bacik 已提交
1026 1027 1028

		atomic_inc(&config->live_connections);
		wake_up(&config->conn_wait);
1029 1030 1031 1032 1033 1034 1035
		return 0;
	}
	sockfd_put(sock);
	kfree(args);
	return -ENOSPC;
}

1036 1037
static void nbd_bdev_reset(struct block_device *bdev)
{
1038 1039
	if (bdev->bd_openers > 1)
		return;
1040
	bd_set_size(bdev, 0);
1041 1042
}

1043
static void nbd_parse_flags(struct nbd_device *nbd)
1044
{
1045 1046
	struct nbd_config *config = nbd->config;
	if (config->flags & NBD_FLAG_READ_ONLY)
1047 1048 1049
		set_disk_ro(nbd->disk, true);
	else
		set_disk_ro(nbd->disk, false);
1050
	if (config->flags & NBD_FLAG_SEND_TRIM)
1051
		blk_queue_flag_set(QUEUE_FLAG_DISCARD, nbd->disk->queue);
S
Shaun McDowell 已提交
1052 1053 1054 1055 1056 1057
	if (config->flags & NBD_FLAG_SEND_FLUSH) {
		if (config->flags & NBD_FLAG_SEND_FUA)
			blk_queue_write_cache(nbd->disk->queue, true, true);
		else
			blk_queue_write_cache(nbd->disk->queue, true, false);
	}
1058
	else
1059
		blk_queue_write_cache(nbd->disk->queue, false, false);
1060 1061
}

J
Josef Bacik 已提交
1062 1063
static void send_disconnects(struct nbd_device *nbd)
{
1064
	struct nbd_config *config = nbd->config;
A
Al Viro 已提交
1065 1066 1067 1068 1069 1070
	struct nbd_request request = {
		.magic = htonl(NBD_REQUEST_MAGIC),
		.type = htonl(NBD_CMD_DISC),
	};
	struct kvec iov = {.iov_base = &request, .iov_len = sizeof(request)};
	struct iov_iter from;
J
Josef Bacik 已提交
1071 1072
	int i, ret;

1073
	for (i = 0; i < config->num_connections; i++) {
1074 1075
		struct nbd_sock *nsock = config->socks[i];

A
Al Viro 已提交
1076
		iov_iter_kvec(&from, WRITE | ITER_KVEC, &iov, 1, sizeof(request));
1077
		mutex_lock(&nsock->tx_lock);
J
Josef Bacik 已提交
1078
		ret = sock_xmit(nbd, i, 1, &from, 0, NULL);
J
Josef Bacik 已提交
1079 1080 1081
		if (ret <= 0)
			dev_err(disk_to_dev(nbd->disk),
				"Send disconnect failed %d\n", ret);
1082
		mutex_unlock(&nsock->tx_lock);
J
Josef Bacik 已提交
1083 1084 1085
	}
}

1086
static int nbd_disconnect(struct nbd_device *nbd)
J
Josef Bacik 已提交
1087
{
1088
	struct nbd_config *config = nbd->config;
M
Markus Pargmann 已提交
1089

1090
	dev_info(disk_to_dev(nbd->disk), "NBD_DISCONNECT\n");
1091 1092
	set_bit(NBD_DISCONNECT_REQUESTED, &config->runtime_flags);
	send_disconnects(nbd);
J
Josef Bacik 已提交
1093 1094 1095
	return 0;
}

1096
static void nbd_clear_sock(struct nbd_device *nbd)
P
Pavel Machek 已提交
1097
{
J
Josef Bacik 已提交
1098 1099
	sock_shutdown(nbd);
	nbd_clear_que(nbd);
1100 1101 1102 1103 1104 1105 1106 1107 1108
	nbd->task_setup = NULL;
}

static void nbd_config_put(struct nbd_device *nbd)
{
	if (refcount_dec_and_mutex_lock(&nbd->config_refs,
					&nbd->config_lock)) {
		struct nbd_config *config = nbd->config;
		nbd_dev_dbg_close(nbd);
1109
		nbd_size_clear(nbd);
1110 1111 1112 1113
		if (test_and_clear_bit(NBD_HAS_PID_FILE,
				       &config->runtime_flags))
			device_remove_file(disk_to_dev(nbd->disk), &pid_attr);
		nbd->task_recv = NULL;
1114
		nbd_clear_sock(nbd);
1115 1116 1117 1118 1119 1120 1121 1122
		if (config->num_connections) {
			int i;
			for (i = 0; i < config->num_connections; i++) {
				sockfd_put(config->socks[i]->sock);
				kfree(config->socks[i]);
			}
			kfree(config->socks);
		}
I
Ilya Dryomov 已提交
1123
		kfree(nbd->config);
1124 1125 1126
		nbd->config = NULL;

		nbd->tag_set.timeout = 0;
1127
		nbd->disk->queue->limits.discard_granularity = 0;
1128
		nbd->disk->queue->limits.discard_alignment = 0;
1129
		blk_queue_max_discard_sectors(nbd->disk->queue, UINT_MAX);
1130
		blk_queue_flag_clear(QUEUE_FLAG_DISCARD, nbd->disk->queue);
1131

1132
		mutex_unlock(&nbd->config_lock);
J
Josef Bacik 已提交
1133
		nbd_put(nbd);
1134 1135
		module_put(THIS_MODULE);
	}
J
Josef Bacik 已提交
1136 1137
}

J
Josef Bacik 已提交
1138
static int nbd_start_device(struct nbd_device *nbd)
J
Josef Bacik 已提交
1139
{
1140 1141
	struct nbd_config *config = nbd->config;
	int num_connections = config->num_connections;
J
Josef Bacik 已提交
1142
	int error = 0, i;
P
Pavel Machek 已提交
1143

J
Josef Bacik 已提交
1144 1145
	if (nbd->task_recv)
		return -EBUSY;
1146
	if (!config->socks)
J
Josef Bacik 已提交
1147 1148
		return -EINVAL;
	if (num_connections > 1 &&
1149
	    !(config->flags & NBD_FLAG_CAN_MULTI_CONN)) {
J
Josef Bacik 已提交
1150
		dev_err(disk_to_dev(nbd->disk), "server does not support multiple connections per device.\n");
1151
		return -EINVAL;
J
Josef Bacik 已提交
1152
	}
M
Markus Pargmann 已提交
1153

1154
	blk_mq_update_nr_hw_queues(&nbd->tag_set, config->num_connections);
J
Josef Bacik 已提交
1155
	nbd->task_recv = current;
M
Markus Pargmann 已提交
1156

1157
	nbd_parse_flags(nbd);
M
Markus Pargmann 已提交
1158

J
Josef Bacik 已提交
1159 1160 1161
	error = device_create_file(disk_to_dev(nbd->disk), &pid_attr);
	if (error) {
		dev_err(disk_to_dev(nbd->disk), "device_create_file failed!\n");
1162
		return error;
P
Pavel Machek 已提交
1163
	}
1164
	set_bit(NBD_HAS_PID_FILE, &config->runtime_flags);
1165

J
Josef Bacik 已提交
1166 1167
	nbd_dev_dbg_init(nbd);
	for (i = 0; i < num_connections; i++) {
1168 1169 1170 1171 1172 1173 1174 1175
		struct recv_thread_args *args;

		args = kzalloc(sizeof(*args), GFP_KERNEL);
		if (!args) {
			sock_shutdown(nbd);
			return -ENOMEM;
		}
		sk_set_memalloc(config->socks[i]->sock->sk);
1176 1177 1178
		if (nbd->tag_set.timeout)
			config->socks[i]->sock->sk->sk_sndtimeo =
				nbd->tag_set.timeout;
1179 1180 1181 1182 1183 1184
		atomic_inc(&config->recv_threads);
		refcount_inc(&nbd->config_refs);
		INIT_WORK(&args->work, recv_work);
		args->nbd = nbd;
		args->index = i;
		queue_work(recv_workqueue, &args->work);
1185
	}
1186
	nbd_size_update(nbd);
J
Josef Bacik 已提交
1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202
	return error;
}

static int nbd_start_device_ioctl(struct nbd_device *nbd, struct block_device *bdev)
{
	struct nbd_config *config = nbd->config;
	int ret;

	ret = nbd_start_device(nbd);
	if (ret)
		return ret;

	if (max_part)
		bdev->bd_invalidated = 1;
	mutex_unlock(&nbd->config_lock);
	ret = wait_event_interruptible(config->recv_wq,
1203
					 atomic_read(&config->recv_threads) == 0);
J
Josef Bacik 已提交
1204
	if (ret)
1205
		sock_shutdown(nbd);
J
Josef Bacik 已提交
1206
	mutex_lock(&nbd->config_lock);
1207
	nbd_bdev_reset(bdev);
J
Josef Bacik 已提交
1208
	/* user requested, ignore socket errors */
1209
	if (test_bit(NBD_DISCONNECT_REQUESTED, &config->runtime_flags))
J
Josef Bacik 已提交
1210
		ret = 0;
1211
	if (test_bit(NBD_TIMEDOUT, &config->runtime_flags))
J
Josef Bacik 已提交
1212 1213
		ret = -ETIMEDOUT;
	return ret;
J
Josef Bacik 已提交
1214 1215
}

1216 1217 1218
static void nbd_clear_sock_ioctl(struct nbd_device *nbd,
				 struct block_device *bdev)
{
1219
	sock_shutdown(nbd);
1220 1221
	kill_bdev(bdev);
	nbd_bdev_reset(bdev);
J
Josef Bacik 已提交
1222 1223 1224
	if (test_and_clear_bit(NBD_HAS_CONFIG_REF,
			       &nbd->config->runtime_flags))
		nbd_config_put(nbd);
1225 1226
}

J
Josef Bacik 已提交
1227 1228 1229 1230
/* Must be called with config_lock held */
static int __nbd_ioctl(struct block_device *bdev, struct nbd_device *nbd,
		       unsigned int cmd, unsigned long arg)
{
1231 1232
	struct nbd_config *config = nbd->config;

J
Josef Bacik 已提交
1233 1234
	switch (cmd) {
	case NBD_DISCONNECT:
1235
		return nbd_disconnect(nbd);
J
Josef Bacik 已提交
1236
	case NBD_CLEAR_SOCK:
1237 1238
		nbd_clear_sock_ioctl(nbd, bdev);
		return 0;
J
Josef Bacik 已提交
1239
	case NBD_SET_SOCK:
J
Josef Bacik 已提交
1240
		return nbd_add_socket(nbd, arg, false);
J
Josef Bacik 已提交
1241
	case NBD_SET_BLKSIZE:
1242
		nbd_size_set(nbd, arg,
1243
			     div_s64(config->bytesize, arg));
1244
		return 0;
L
Linus Torvalds 已提交
1245
	case NBD_SET_SIZE:
1246
		nbd_size_set(nbd, config->blksize,
1247
			     div_s64(arg, config->blksize));
1248
		return 0;
1249
	case NBD_SET_SIZE_BLOCKS:
1250
		nbd_size_set(nbd, config->blksize, arg);
1251
		return 0;
1252
	case NBD_SET_TIMEOUT:
J
Josef Bacik 已提交
1253 1254 1255 1256
		if (arg) {
			nbd->tag_set.timeout = arg * HZ;
			blk_queue_rq_timeout(nbd->disk->queue, arg * HZ);
		}
1257
		return 0;
P
Pavel Machek 已提交
1258

P
Paul Clements 已提交
1259
	case NBD_SET_FLAGS:
1260
		config->flags = arg;
P
Paul Clements 已提交
1261
		return 0;
J
Josef Bacik 已提交
1262
	case NBD_DO_IT:
J
Josef Bacik 已提交
1263
		return nbd_start_device_ioctl(nbd, bdev);
L
Linus Torvalds 已提交
1264
	case NBD_CLEAR_QUE:
1265 1266 1267 1268
		/*
		 * This is for compatibility only.  The queue is always cleared
		 * by NBD_DO_IT or NBD_CLEAR_SOCK.
		 */
L
Linus Torvalds 已提交
1269 1270
		return 0;
	case NBD_PRINT_DEBUG:
J
Josef Bacik 已提交
1271 1272 1273 1274
		/*
		 * For compatibility only, we no longer keep a list of
		 * outstanding requests.
		 */
L
Linus Torvalds 已提交
1275 1276
		return 0;
	}
P
Pavel Machek 已提交
1277 1278 1279 1280 1281 1282
	return -ENOTTY;
}

static int nbd_ioctl(struct block_device *bdev, fmode_t mode,
		     unsigned int cmd, unsigned long arg)
{
1283
	struct nbd_device *nbd = bdev->bd_disk->private_data;
J
Josef Bacik 已提交
1284 1285
	struct nbd_config *config = nbd->config;
	int error = -EINVAL;
P
Pavel Machek 已提交
1286 1287 1288 1289

	if (!capable(CAP_SYS_ADMIN))
		return -EPERM;

J
Josef Bacik 已提交
1290 1291 1292 1293 1294 1295
	/* The block layer will pass back some non-nbd ioctls in case we have
	 * special handling for them, but we don't so just return an error.
	 */
	if (_IOC_TYPE(cmd) != 0xab)
		return -EINVAL;

J
Josef Bacik 已提交
1296
	mutex_lock(&nbd->config_lock);
J
Josef Bacik 已提交
1297 1298 1299 1300 1301 1302 1303 1304 1305

	/* Don't allow ioctl operations on a nbd device that was created with
	 * netlink, unless it's DISCONNECT or CLEAR_SOCK, which are fine.
	 */
	if (!test_bit(NBD_BOUND, &config->runtime_flags) ||
	    (cmd == NBD_DISCONNECT || cmd == NBD_CLEAR_SOCK))
		error = __nbd_ioctl(bdev, nbd, cmd, arg);
	else
		dev_err(nbd_to_dev(nbd), "Cannot use ioctl interface on a netlink controlled device.\n");
J
Josef Bacik 已提交
1306
	mutex_unlock(&nbd->config_lock);
P
Pavel Machek 已提交
1307
	return error;
L
Linus Torvalds 已提交
1308 1309
}

1310 1311 1312 1313 1314 1315 1316 1317 1318
static struct nbd_config *nbd_alloc_config(void)
{
	struct nbd_config *config;

	config = kzalloc(sizeof(struct nbd_config), GFP_NOFS);
	if (!config)
		return NULL;
	atomic_set(&config->recv_threads, 0);
	init_waitqueue_head(&config->recv_wq);
J
Josef Bacik 已提交
1319
	init_waitqueue_head(&config->conn_wait);
1320
	config->blksize = 1024;
J
Josef Bacik 已提交
1321
	atomic_set(&config->live_connections, 0);
1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336
	try_module_get(THIS_MODULE);
	return config;
}

static int nbd_open(struct block_device *bdev, fmode_t mode)
{
	struct nbd_device *nbd;
	int ret = 0;

	mutex_lock(&nbd_index_mutex);
	nbd = bdev->bd_disk->private_data;
	if (!nbd) {
		ret = -ENXIO;
		goto out;
	}
J
Josef Bacik 已提交
1337 1338 1339 1340
	if (!refcount_inc_not_zero(&nbd->refs)) {
		ret = -ENXIO;
		goto out;
	}
1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355
	if (!refcount_inc_not_zero(&nbd->config_refs)) {
		struct nbd_config *config;

		mutex_lock(&nbd->config_lock);
		if (refcount_inc_not_zero(&nbd->config_refs)) {
			mutex_unlock(&nbd->config_lock);
			goto out;
		}
		config = nbd->config = nbd_alloc_config();
		if (!config) {
			ret = -ENOMEM;
			mutex_unlock(&nbd->config_lock);
			goto out;
		}
		refcount_set(&nbd->config_refs, 1);
J
Josef Bacik 已提交
1356
		refcount_inc(&nbd->refs);
1357
		mutex_unlock(&nbd->config_lock);
J
Josef Bacik 已提交
1358 1359 1360
		bdev->bd_invalidated = 1;
	} else if (nbd_disconnected(nbd->config)) {
		bdev->bd_invalidated = 1;
1361 1362 1363 1364 1365 1366 1367 1368 1369
	}
out:
	mutex_unlock(&nbd_index_mutex);
	return ret;
}

static void nbd_release(struct gendisk *disk, fmode_t mode)
{
	struct nbd_device *nbd = disk->private_data;
1370 1371 1372 1373 1374 1375
	struct block_device *bdev = bdget_disk(disk, 0);

	if (test_bit(NBD_DISCONNECT_ON_CLOSE, &nbd->config->runtime_flags) &&
			bdev->bd_openers == 0)
		nbd_disconnect_and_put(nbd);

1376
	nbd_config_put(nbd);
J
Josef Bacik 已提交
1377
	nbd_put(nbd);
1378 1379
}

1380
static const struct block_device_operations nbd_fops =
L
Linus Torvalds 已提交
1381 1382
{
	.owner =	THIS_MODULE,
1383 1384
	.open =		nbd_open,
	.release =	nbd_release,
1385
	.ioctl =	nbd_ioctl,
A
Al Viro 已提交
1386
	.compat_ioctl =	nbd_ioctl,
L
Linus Torvalds 已提交
1387 1388
};

M
Markus Pargmann 已提交
1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415
#if IS_ENABLED(CONFIG_DEBUG_FS)

static int nbd_dbg_tasks_show(struct seq_file *s, void *unused)
{
	struct nbd_device *nbd = s->private;

	if (nbd->task_recv)
		seq_printf(s, "recv: %d\n", task_pid_nr(nbd->task_recv));

	return 0;
}

static int nbd_dbg_tasks_open(struct inode *inode, struct file *file)
{
	return single_open(file, nbd_dbg_tasks_show, inode->i_private);
}

static const struct file_operations nbd_dbg_tasks_ops = {
	.open = nbd_dbg_tasks_open,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
};

static int nbd_dbg_flags_show(struct seq_file *s, void *unused)
{
	struct nbd_device *nbd = s->private;
1416
	u32 flags = nbd->config->flags;
M
Markus Pargmann 已提交
1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427

	seq_printf(s, "Hex: 0x%08x\n\n", flags);

	seq_puts(s, "Known flags:\n");

	if (flags & NBD_FLAG_HAS_FLAGS)
		seq_puts(s, "NBD_FLAG_HAS_FLAGS\n");
	if (flags & NBD_FLAG_READ_ONLY)
		seq_puts(s, "NBD_FLAG_READ_ONLY\n");
	if (flags & NBD_FLAG_SEND_FLUSH)
		seq_puts(s, "NBD_FLAG_SEND_FLUSH\n");
S
Shaun McDowell 已提交
1428 1429
	if (flags & NBD_FLAG_SEND_FUA)
		seq_puts(s, "NBD_FLAG_SEND_FUA\n");
M
Markus Pargmann 已提交
1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450
	if (flags & NBD_FLAG_SEND_TRIM)
		seq_puts(s, "NBD_FLAG_SEND_TRIM\n");

	return 0;
}

static int nbd_dbg_flags_open(struct inode *inode, struct file *file)
{
	return single_open(file, nbd_dbg_flags_show, inode->i_private);
}

static const struct file_operations nbd_dbg_flags_ops = {
	.open = nbd_dbg_flags_open,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
};

static int nbd_dev_dbg_init(struct nbd_device *nbd)
{
	struct dentry *dir;
1451
	struct nbd_config *config = nbd->config;
1452 1453 1454

	if (!nbd_dbg_dir)
		return -EIO;
M
Markus Pargmann 已提交
1455 1456

	dir = debugfs_create_dir(nbd_name(nbd), nbd_dbg_dir);
1457 1458 1459 1460
	if (!dir) {
		dev_err(nbd_to_dev(nbd), "Failed to create debugfs dir for '%s'\n",
			nbd_name(nbd));
		return -EIO;
M
Markus Pargmann 已提交
1461
	}
1462
	config->dbg_dir = dir;
M
Markus Pargmann 已提交
1463

1464
	debugfs_create_file("tasks", 0444, dir, nbd, &nbd_dbg_tasks_ops);
1465
	debugfs_create_u64("size_bytes", 0444, dir, &config->bytesize);
1466
	debugfs_create_u32("timeout", 0444, dir, &nbd->tag_set.timeout);
1467
	debugfs_create_u64("blocksize", 0444, dir, &config->blksize);
1468
	debugfs_create_file("flags", 0444, dir, nbd, &nbd_dbg_flags_ops);
M
Markus Pargmann 已提交
1469 1470 1471 1472 1473 1474

	return 0;
}

static void nbd_dev_dbg_close(struct nbd_device *nbd)
{
1475
	debugfs_remove_recursive(nbd->config->dbg_dir);
M
Markus Pargmann 已提交
1476 1477 1478 1479 1480 1481 1482
}

static int nbd_dbg_init(void)
{
	struct dentry *dbg_dir;

	dbg_dir = debugfs_create_dir("nbd", NULL);
1483 1484
	if (!dbg_dir)
		return -EIO;
M
Markus Pargmann 已提交
1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517

	nbd_dbg_dir = dbg_dir;

	return 0;
}

static void nbd_dbg_close(void)
{
	debugfs_remove_recursive(nbd_dbg_dir);
}

#else  /* IS_ENABLED(CONFIG_DEBUG_FS) */

static int nbd_dev_dbg_init(struct nbd_device *nbd)
{
	return 0;
}

static void nbd_dev_dbg_close(struct nbd_device *nbd)
{
}

static int nbd_dbg_init(void)
{
	return 0;
}

static void nbd_dbg_close(void)
{
}

#endif

1518 1519
static int nbd_init_request(struct blk_mq_tag_set *set, struct request *rq,
			    unsigned int hctx_idx, unsigned int numa_node)
J
Josef Bacik 已提交
1520 1521
{
	struct nbd_cmd *cmd = blk_mq_rq_to_pdu(rq);
1522
	cmd->nbd = set->driver_data;
1523
	cmd->flags = 0;
1524
	mutex_init(&cmd->lock);
J
Josef Bacik 已提交
1525 1526 1527
	return 0;
}

1528
static const struct blk_mq_ops nbd_mq_ops = {
J
Josef Bacik 已提交
1529
	.queue_rq	= nbd_queue_rq,
C
Christoph Hellwig 已提交
1530
	.complete	= nbd_complete_rq,
J
Josef Bacik 已提交
1531
	.init_request	= nbd_init_request,
1532
	.timeout	= nbd_xmit_timeout,
J
Josef Bacik 已提交
1533 1534
};

1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562
static int nbd_dev_add(int index)
{
	struct nbd_device *nbd;
	struct gendisk *disk;
	struct request_queue *q;
	int err = -ENOMEM;

	nbd = kzalloc(sizeof(struct nbd_device), GFP_KERNEL);
	if (!nbd)
		goto out;

	disk = alloc_disk(1 << part_shift);
	if (!disk)
		goto out_free_nbd;

	if (index >= 0) {
		err = idr_alloc(&nbd_index_idr, nbd, index, index + 1,
				GFP_KERNEL);
		if (err == -ENOSPC)
			err = -EEXIST;
	} else {
		err = idr_alloc(&nbd_index_idr, nbd, 0, 0, GFP_KERNEL);
		if (err >= 0)
			index = err;
	}
	if (err < 0)
		goto out_free_disk;

J
Josef Bacik 已提交
1563
	nbd->index = index;
1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587
	nbd->disk = disk;
	nbd->tag_set.ops = &nbd_mq_ops;
	nbd->tag_set.nr_hw_queues = 1;
	nbd->tag_set.queue_depth = 128;
	nbd->tag_set.numa_node = NUMA_NO_NODE;
	nbd->tag_set.cmd_size = sizeof(struct nbd_cmd);
	nbd->tag_set.flags = BLK_MQ_F_SHOULD_MERGE |
		BLK_MQ_F_SG_MERGE | BLK_MQ_F_BLOCKING;
	nbd->tag_set.driver_data = nbd;

	err = blk_mq_alloc_tag_set(&nbd->tag_set);
	if (err)
		goto out_free_idr;

	q = blk_mq_init_queue(&nbd->tag_set);
	if (IS_ERR(q)) {
		err = PTR_ERR(q);
		goto out_free_tags;
	}
	disk->queue = q;

	/*
	 * Tell the block layer that we are not a rotational device
	 */
1588 1589
	blk_queue_flag_set(QUEUE_FLAG_NONROT, disk->queue);
	blk_queue_flag_clear(QUEUE_FLAG_ADD_RANDOM, disk->queue);
1590
	disk->queue->limits.discard_granularity = 0;
1591
	disk->queue->limits.discard_alignment = 0;
1592
	blk_queue_max_discard_sectors(disk->queue, 0);
1593
	blk_queue_max_segment_size(disk->queue, UINT_MAX);
1594
	blk_queue_max_segments(disk->queue, USHRT_MAX);
1595 1596 1597 1598
	blk_queue_max_hw_sectors(disk->queue, 65536);
	disk->queue->limits.max_sectors = 256;

	mutex_init(&nbd->config_lock);
1599
	refcount_set(&nbd->config_refs, 0);
J
Josef Bacik 已提交
1600 1601
	refcount_set(&nbd->refs, 1);
	INIT_LIST_HEAD(&nbd->list);
1602 1603 1604 1605 1606 1607
	disk->major = NBD_MAJOR;
	disk->first_minor = index << part_shift;
	disk->fops = &nbd_fops;
	disk->private_data = nbd;
	sprintf(disk->disk_name, "nbd%d", index);
	add_disk(disk);
J
Josef Bacik 已提交
1608
	nbd_total_devices++;
1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622
	return index;

out_free_tags:
	blk_mq_free_tag_set(&nbd->tag_set);
out_free_idr:
	idr_remove(&nbd_index_idr, index);
out_free_disk:
	put_disk(disk);
out_free_nbd:
	kfree(nbd);
out:
	return err;
}

J
Josef Bacik 已提交
1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635
static int find_free_cb(int id, void *ptr, void *data)
{
	struct nbd_device *nbd = ptr;
	struct nbd_device **found = data;

	if (!refcount_read(&nbd->config_refs)) {
		*found = nbd;
		return 1;
	}
	return 0;
}

/* Netlink interface. */
S
Stephen Hemminger 已提交
1636
static const struct nla_policy nbd_attr_policy[NBD_ATTR_MAX + 1] = {
J
Josef Bacik 已提交
1637 1638 1639 1640 1641 1642 1643
	[NBD_ATTR_INDEX]		=	{ .type = NLA_U32 },
	[NBD_ATTR_SIZE_BYTES]		=	{ .type = NLA_U64 },
	[NBD_ATTR_BLOCK_SIZE_BYTES]	=	{ .type = NLA_U64 },
	[NBD_ATTR_TIMEOUT]		=	{ .type = NLA_U64 },
	[NBD_ATTR_SERVER_FLAGS]		=	{ .type = NLA_U64 },
	[NBD_ATTR_CLIENT_FLAGS]		=	{ .type = NLA_U64 },
	[NBD_ATTR_SOCKETS]		=	{ .type = NLA_NESTED},
J
Josef Bacik 已提交
1644
	[NBD_ATTR_DEAD_CONN_TIMEOUT]	=	{ .type = NLA_U64 },
J
Josef Bacik 已提交
1645
	[NBD_ATTR_DEVICE_LIST]		=	{ .type = NLA_NESTED},
J
Josef Bacik 已提交
1646 1647
};

S
Stephen Hemminger 已提交
1648
static const struct nla_policy nbd_sock_policy[NBD_SOCK_MAX + 1] = {
J
Josef Bacik 已提交
1649 1650 1651
	[NBD_SOCK_FD]			=	{ .type = NLA_U32 },
};

J
Josef Bacik 已提交
1652 1653 1654
/* We don't use this right now since we don't parse the incoming list, but we
 * still want it here so userspace knows what to expect.
 */
S
Stephen Hemminger 已提交
1655
static const struct nla_policy __attribute__((unused))
J
Josef Bacik 已提交
1656 1657 1658 1659 1660
nbd_device_policy[NBD_DEVICE_ATTR_MAX + 1] = {
	[NBD_DEVICE_INDEX]		=	{ .type = NLA_U32 },
	[NBD_DEVICE_CONNECTED]		=	{ .type = NLA_U8 },
};

J
Josef Bacik 已提交
1661 1662 1663 1664 1665 1666
static int nbd_genl_connect(struct sk_buff *skb, struct genl_info *info)
{
	struct nbd_device *nbd = NULL;
	struct nbd_config *config;
	int index = -1;
	int ret;
1667
	bool put_dev = false;
J
Josef Bacik 已提交
1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691

	if (!netlink_capable(skb, CAP_SYS_ADMIN))
		return -EPERM;

	if (info->attrs[NBD_ATTR_INDEX])
		index = nla_get_u32(info->attrs[NBD_ATTR_INDEX]);
	if (!info->attrs[NBD_ATTR_SOCKETS]) {
		printk(KERN_ERR "nbd: must specify at least one socket\n");
		return -EINVAL;
	}
	if (!info->attrs[NBD_ATTR_SIZE_BYTES]) {
		printk(KERN_ERR "nbd: must specify a size in bytes for the device\n");
		return -EINVAL;
	}
again:
	mutex_lock(&nbd_index_mutex);
	if (index == -1) {
		ret = idr_for_each(&nbd_index_idr, &find_free_cb, &nbd);
		if (ret == 0) {
			int new_index;
			new_index = nbd_dev_add(-1);
			if (new_index < 0) {
				mutex_unlock(&nbd_index_mutex);
				printk(KERN_ERR "nbd: failed to add new device\n");
1692
				return new_index;
J
Josef Bacik 已提交
1693 1694 1695 1696 1697
			}
			nbd = idr_find(&nbd_index_idr, new_index);
		}
	} else {
		nbd = idr_find(&nbd_index_idr, index);
1698 1699 1700 1701 1702 1703 1704 1705 1706
		if (!nbd) {
			ret = nbd_dev_add(index);
			if (ret < 0) {
				mutex_unlock(&nbd_index_mutex);
				printk(KERN_ERR "nbd: failed to add new device\n");
				return ret;
			}
			nbd = idr_find(&nbd_index_idr, index);
		}
J
Josef Bacik 已提交
1707 1708 1709 1710
	}
	if (!nbd) {
		printk(KERN_ERR "nbd: couldn't find device at index %d\n",
		       index);
J
Josef Bacik 已提交
1711 1712 1713 1714 1715 1716 1717 1718 1719
		mutex_unlock(&nbd_index_mutex);
		return -EINVAL;
	}
	if (!refcount_inc_not_zero(&nbd->refs)) {
		mutex_unlock(&nbd_index_mutex);
		if (index == -1)
			goto again;
		printk(KERN_ERR "nbd: device at index %d is going down\n",
		       index);
J
Josef Bacik 已提交
1720 1721
		return -EINVAL;
	}
J
Josef Bacik 已提交
1722
	mutex_unlock(&nbd_index_mutex);
J
Josef Bacik 已提交
1723 1724 1725 1726

	mutex_lock(&nbd->config_lock);
	if (refcount_read(&nbd->config_refs)) {
		mutex_unlock(&nbd->config_lock);
J
Josef Bacik 已提交
1727
		nbd_put(nbd);
J
Josef Bacik 已提交
1728 1729 1730 1731 1732 1733 1734
		if (index == -1)
			goto again;
		printk(KERN_ERR "nbd: nbd%d already in use\n", index);
		return -EBUSY;
	}
	if (WARN_ON(nbd->config)) {
		mutex_unlock(&nbd->config_lock);
J
Josef Bacik 已提交
1735
		nbd_put(nbd);
J
Josef Bacik 已提交
1736 1737 1738 1739 1740
		return -EINVAL;
	}
	config = nbd->config = nbd_alloc_config();
	if (!nbd->config) {
		mutex_unlock(&nbd->config_lock);
J
Josef Bacik 已提交
1741
		nbd_put(nbd);
J
Josef Bacik 已提交
1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762
		printk(KERN_ERR "nbd: couldn't allocate config\n");
		return -ENOMEM;
	}
	refcount_set(&nbd->config_refs, 1);
	set_bit(NBD_BOUND, &config->runtime_flags);

	if (info->attrs[NBD_ATTR_SIZE_BYTES]) {
		u64 bytes = nla_get_u64(info->attrs[NBD_ATTR_SIZE_BYTES]);
		nbd_size_set(nbd, config->blksize,
			     div64_u64(bytes, config->blksize));
	}
	if (info->attrs[NBD_ATTR_BLOCK_SIZE_BYTES]) {
		u64 bsize =
			nla_get_u64(info->attrs[NBD_ATTR_BLOCK_SIZE_BYTES]);
		nbd_size_set(nbd, bsize, div64_u64(config->bytesize, bsize));
	}
	if (info->attrs[NBD_ATTR_TIMEOUT]) {
		u64 timeout = nla_get_u64(info->attrs[NBD_ATTR_TIMEOUT]);
		nbd->tag_set.timeout = timeout * HZ;
		blk_queue_rq_timeout(nbd->disk->queue, timeout * HZ);
	}
J
Josef Bacik 已提交
1763 1764 1765 1766 1767
	if (info->attrs[NBD_ATTR_DEAD_CONN_TIMEOUT]) {
		config->dead_conn_timeout =
			nla_get_u64(info->attrs[NBD_ATTR_DEAD_CONN_TIMEOUT]);
		config->dead_conn_timeout *= HZ;
	}
J
Josef Bacik 已提交
1768 1769 1770
	if (info->attrs[NBD_ATTR_SERVER_FLAGS])
		config->flags =
			nla_get_u64(info->attrs[NBD_ATTR_SERVER_FLAGS]);
1771 1772 1773 1774 1775 1776 1777
	if (info->attrs[NBD_ATTR_CLIENT_FLAGS]) {
		u64 flags = nla_get_u64(info->attrs[NBD_ATTR_CLIENT_FLAGS]);
		if (flags & NBD_CFLAG_DESTROY_ON_DISCONNECT) {
			set_bit(NBD_DESTROY_ON_DISCONNECT,
				&config->runtime_flags);
			put_dev = true;
		}
1778 1779 1780 1781
		if (flags & NBD_CFLAG_DISCONNECT_ON_CLOSE) {
			set_bit(NBD_DISCONNECT_ON_CLOSE,
				&config->runtime_flags);
		}
1782 1783
	}

J
Josef Bacik 已提交
1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797
	if (info->attrs[NBD_ATTR_SOCKETS]) {
		struct nlattr *attr;
		int rem, fd;

		nla_for_each_nested(attr, info->attrs[NBD_ATTR_SOCKETS],
				    rem) {
			struct nlattr *socks[NBD_SOCK_MAX+1];

			if (nla_type(attr) != NBD_SOCK_ITEM) {
				printk(KERN_ERR "nbd: socks must be embedded in a SOCK_ITEM attr\n");
				ret = -EINVAL;
				goto out;
			}
			ret = nla_parse_nested(socks, NBD_SOCK_MAX, attr,
1798
					       nbd_sock_policy, info->extack);
J
Josef Bacik 已提交
1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820
			if (ret != 0) {
				printk(KERN_ERR "nbd: error processing sock list\n");
				ret = -EINVAL;
				goto out;
			}
			if (!socks[NBD_SOCK_FD])
				continue;
			fd = (int)nla_get_u32(socks[NBD_SOCK_FD]);
			ret = nbd_add_socket(nbd, fd, true);
			if (ret)
				goto out;
		}
	}
	ret = nbd_start_device(nbd);
out:
	mutex_unlock(&nbd->config_lock);
	if (!ret) {
		set_bit(NBD_HAS_CONFIG_REF, &config->runtime_flags);
		refcount_inc(&nbd->config_refs);
		nbd_connect_reply(info, nbd->index);
	}
	nbd_config_put(nbd);
1821 1822
	if (put_dev)
		nbd_put(nbd);
J
Josef Bacik 已提交
1823 1824 1825
	return ret;
}

1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836
static void nbd_disconnect_and_put(struct nbd_device *nbd)
{
	mutex_lock(&nbd->config_lock);
	nbd_disconnect(nbd);
	nbd_clear_sock(nbd);
	mutex_unlock(&nbd->config_lock);
	if (test_and_clear_bit(NBD_HAS_CONFIG_REF,
			       &nbd->config->runtime_flags))
		nbd_config_put(nbd);
}

J
Josef Bacik 已提交
1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852
static int nbd_genl_disconnect(struct sk_buff *skb, struct genl_info *info)
{
	struct nbd_device *nbd;
	int index;

	if (!netlink_capable(skb, CAP_SYS_ADMIN))
		return -EPERM;

	if (!info->attrs[NBD_ATTR_INDEX]) {
		printk(KERN_ERR "nbd: must specify an index to disconnect\n");
		return -EINVAL;
	}
	index = nla_get_u32(info->attrs[NBD_ATTR_INDEX]);
	mutex_lock(&nbd_index_mutex);
	nbd = idr_find(&nbd_index_idr, index);
	if (!nbd) {
J
Josef Bacik 已提交
1853
		mutex_unlock(&nbd_index_mutex);
J
Josef Bacik 已提交
1854 1855 1856 1857
		printk(KERN_ERR "nbd: couldn't find device at index %d\n",
		       index);
		return -EINVAL;
	}
J
Josef Bacik 已提交
1858 1859 1860 1861 1862 1863 1864 1865 1866
	if (!refcount_inc_not_zero(&nbd->refs)) {
		mutex_unlock(&nbd_index_mutex);
		printk(KERN_ERR "nbd: device at index %d is going down\n",
		       index);
		return -EINVAL;
	}
	mutex_unlock(&nbd_index_mutex);
	if (!refcount_inc_not_zero(&nbd->config_refs)) {
		nbd_put(nbd);
J
Josef Bacik 已提交
1867
		return 0;
J
Josef Bacik 已提交
1868
	}
1869
	nbd_disconnect_and_put(nbd);
J
Josef Bacik 已提交
1870
	nbd_config_put(nbd);
J
Josef Bacik 已提交
1871
	nbd_put(nbd);
J
Josef Bacik 已提交
1872 1873 1874
	return 0;
}

1875 1876 1877 1878 1879
static int nbd_genl_reconfigure(struct sk_buff *skb, struct genl_info *info)
{
	struct nbd_device *nbd = NULL;
	struct nbd_config *config;
	int index;
1880
	int ret = 0;
1881
	bool put_dev = false;
1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893

	if (!netlink_capable(skb, CAP_SYS_ADMIN))
		return -EPERM;

	if (!info->attrs[NBD_ATTR_INDEX]) {
		printk(KERN_ERR "nbd: must specify a device to reconfigure\n");
		return -EINVAL;
	}
	index = nla_get_u32(info->attrs[NBD_ATTR_INDEX]);
	mutex_lock(&nbd_index_mutex);
	nbd = idr_find(&nbd_index_idr, index);
	if (!nbd) {
J
Josef Bacik 已提交
1894
		mutex_unlock(&nbd_index_mutex);
1895 1896 1897 1898
		printk(KERN_ERR "nbd: couldn't find a device at index %d\n",
		       index);
		return -EINVAL;
	}
J
Josef Bacik 已提交
1899 1900 1901 1902 1903 1904 1905
	if (!refcount_inc_not_zero(&nbd->refs)) {
		mutex_unlock(&nbd_index_mutex);
		printk(KERN_ERR "nbd: device at index %d is going down\n",
		       index);
		return -EINVAL;
	}
	mutex_unlock(&nbd_index_mutex);
1906 1907 1908 1909

	if (!refcount_inc_not_zero(&nbd->config_refs)) {
		dev_err(nbd_to_dev(nbd),
			"not configured, cannot reconfigure\n");
J
Josef Bacik 已提交
1910
		nbd_put(nbd);
1911 1912 1913 1914 1915 1916 1917 1918 1919
		return -EINVAL;
	}

	mutex_lock(&nbd->config_lock);
	config = nbd->config;
	if (!test_bit(NBD_BOUND, &config->runtime_flags) ||
	    !nbd->task_recv) {
		dev_err(nbd_to_dev(nbd),
			"not configured, cannot reconfigure\n");
1920
		ret = -EINVAL;
1921 1922 1923 1924 1925 1926 1927 1928
		goto out;
	}

	if (info->attrs[NBD_ATTR_TIMEOUT]) {
		u64 timeout = nla_get_u64(info->attrs[NBD_ATTR_TIMEOUT]);
		nbd->tag_set.timeout = timeout * HZ;
		blk_queue_rq_timeout(nbd->disk->queue, timeout * HZ);
	}
J
Josef Bacik 已提交
1929 1930 1931 1932 1933
	if (info->attrs[NBD_ATTR_DEAD_CONN_TIMEOUT]) {
		config->dead_conn_timeout =
			nla_get_u64(info->attrs[NBD_ATTR_DEAD_CONN_TIMEOUT]);
		config->dead_conn_timeout *= HZ;
	}
1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944
	if (info->attrs[NBD_ATTR_CLIENT_FLAGS]) {
		u64 flags = nla_get_u64(info->attrs[NBD_ATTR_CLIENT_FLAGS]);
		if (flags & NBD_CFLAG_DESTROY_ON_DISCONNECT) {
			if (!test_and_set_bit(NBD_DESTROY_ON_DISCONNECT,
					      &config->runtime_flags))
				put_dev = true;
		} else {
			if (test_and_clear_bit(NBD_DESTROY_ON_DISCONNECT,
					       &config->runtime_flags))
				refcount_inc(&nbd->refs);
		}
1945 1946 1947 1948 1949 1950 1951 1952

		if (flags & NBD_CFLAG_DISCONNECT_ON_CLOSE) {
			set_bit(NBD_DISCONNECT_ON_CLOSE,
					&config->runtime_flags);
		} else {
			clear_bit(NBD_DISCONNECT_ON_CLOSE,
					&config->runtime_flags);
		}
1953
	}
1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968

	if (info->attrs[NBD_ATTR_SOCKETS]) {
		struct nlattr *attr;
		int rem, fd;

		nla_for_each_nested(attr, info->attrs[NBD_ATTR_SOCKETS],
				    rem) {
			struct nlattr *socks[NBD_SOCK_MAX+1];

			if (nla_type(attr) != NBD_SOCK_ITEM) {
				printk(KERN_ERR "nbd: socks must be embedded in a SOCK_ITEM attr\n");
				ret = -EINVAL;
				goto out;
			}
			ret = nla_parse_nested(socks, NBD_SOCK_MAX, attr,
1969
					       nbd_sock_policy, info->extack);
1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989
			if (ret != 0) {
				printk(KERN_ERR "nbd: error processing sock list\n");
				ret = -EINVAL;
				goto out;
			}
			if (!socks[NBD_SOCK_FD])
				continue;
			fd = (int)nla_get_u32(socks[NBD_SOCK_FD]);
			ret = nbd_reconnect_socket(nbd, fd);
			if (ret) {
				if (ret == -ENOSPC)
					ret = 0;
				goto out;
			}
			dev_info(nbd_to_dev(nbd), "reconnected socket\n");
		}
	}
out:
	mutex_unlock(&nbd->config_lock);
	nbd_config_put(nbd);
J
Josef Bacik 已提交
1990
	nbd_put(nbd);
1991 1992
	if (put_dev)
		nbd_put(nbd);
1993 1994 1995
	return ret;
}

J
Josef Bacik 已提交
1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006
static const struct genl_ops nbd_connect_genl_ops[] = {
	{
		.cmd	= NBD_CMD_CONNECT,
		.policy	= nbd_attr_policy,
		.doit	= nbd_genl_connect,
	},
	{
		.cmd	= NBD_CMD_DISCONNECT,
		.policy	= nbd_attr_policy,
		.doit	= nbd_genl_disconnect,
	},
2007 2008 2009 2010 2011
	{
		.cmd	= NBD_CMD_RECONFIGURE,
		.policy	= nbd_attr_policy,
		.doit	= nbd_genl_reconfigure,
	},
J
Josef Bacik 已提交
2012 2013 2014 2015 2016
	{
		.cmd	= NBD_CMD_STATUS,
		.policy	= nbd_attr_policy,
		.doit	= nbd_genl_status,
	},
J
Josef Bacik 已提交
2017 2018
};

2019 2020 2021 2022
static const struct genl_multicast_group nbd_mcast_grps[] = {
	{ .name = NBD_GENL_MCAST_GROUP_NAME, },
};

J
Josef Bacik 已提交
2023 2024 2025 2026 2027 2028 2029 2030
static struct genl_family nbd_genl_family __ro_after_init = {
	.hdrsize	= 0,
	.name		= NBD_GENL_FAMILY_NAME,
	.version	= NBD_GENL_VERSION,
	.module		= THIS_MODULE,
	.ops		= nbd_connect_genl_ops,
	.n_ops		= ARRAY_SIZE(nbd_connect_genl_ops),
	.maxattr	= NBD_ATTR_MAX,
2031 2032
	.mcgrps		= nbd_mcast_grps,
	.n_mcgrps	= ARRAY_SIZE(nbd_mcast_grps),
J
Josef Bacik 已提交
2033 2034
};

J
Josef Bacik 已提交
2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124
static int populate_nbd_status(struct nbd_device *nbd, struct sk_buff *reply)
{
	struct nlattr *dev_opt;
	u8 connected = 0;
	int ret;

	/* This is a little racey, but for status it's ok.  The
	 * reason we don't take a ref here is because we can't
	 * take a ref in the index == -1 case as we would need
	 * to put under the nbd_index_mutex, which could
	 * deadlock if we are configured to remove ourselves
	 * once we're disconnected.
	 */
	if (refcount_read(&nbd->config_refs))
		connected = 1;
	dev_opt = nla_nest_start(reply, NBD_DEVICE_ITEM);
	if (!dev_opt)
		return -EMSGSIZE;
	ret = nla_put_u32(reply, NBD_DEVICE_INDEX, nbd->index);
	if (ret)
		return -EMSGSIZE;
	ret = nla_put_u8(reply, NBD_DEVICE_CONNECTED,
			 connected);
	if (ret)
		return -EMSGSIZE;
	nla_nest_end(reply, dev_opt);
	return 0;
}

static int status_cb(int id, void *ptr, void *data)
{
	struct nbd_device *nbd = ptr;
	return populate_nbd_status(nbd, (struct sk_buff *)data);
}

static int nbd_genl_status(struct sk_buff *skb, struct genl_info *info)
{
	struct nlattr *dev_list;
	struct sk_buff *reply;
	void *reply_head;
	size_t msg_size;
	int index = -1;
	int ret = -ENOMEM;

	if (info->attrs[NBD_ATTR_INDEX])
		index = nla_get_u32(info->attrs[NBD_ATTR_INDEX]);

	mutex_lock(&nbd_index_mutex);

	msg_size = nla_total_size(nla_attr_size(sizeof(u32)) +
				  nla_attr_size(sizeof(u8)));
	msg_size *= (index == -1) ? nbd_total_devices : 1;

	reply = genlmsg_new(msg_size, GFP_KERNEL);
	if (!reply)
		goto out;
	reply_head = genlmsg_put_reply(reply, info, &nbd_genl_family, 0,
				       NBD_CMD_STATUS);
	if (!reply_head) {
		nlmsg_free(reply);
		goto out;
	}

	dev_list = nla_nest_start(reply, NBD_ATTR_DEVICE_LIST);
	if (index == -1) {
		ret = idr_for_each(&nbd_index_idr, &status_cb, reply);
		if (ret) {
			nlmsg_free(reply);
			goto out;
		}
	} else {
		struct nbd_device *nbd;
		nbd = idr_find(&nbd_index_idr, index);
		if (nbd) {
			ret = populate_nbd_status(nbd, reply);
			if (ret) {
				nlmsg_free(reply);
				goto out;
			}
		}
	}
	nla_nest_end(reply, dev_list);
	genlmsg_end(reply, reply_head);
	genlmsg_reply(reply, info);
	ret = 0;
out:
	mutex_unlock(&nbd_index_mutex);
	return ret;
}

J
Josef Bacik 已提交
2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147
static void nbd_connect_reply(struct genl_info *info, int index)
{
	struct sk_buff *skb;
	void *msg_head;
	int ret;

	skb = genlmsg_new(nla_total_size(sizeof(u32)), GFP_KERNEL);
	if (!skb)
		return;
	msg_head = genlmsg_put_reply(skb, info, &nbd_genl_family, 0,
				     NBD_CMD_CONNECT);
	if (!msg_head) {
		nlmsg_free(skb);
		return;
	}
	ret = nla_put_u32(skb, NBD_ATTR_INDEX, index);
	if (ret) {
		nlmsg_free(skb);
		return;
	}
	genlmsg_end(skb, msg_head);
	genlmsg_reply(skb, info);
}
L
Linus Torvalds 已提交
2148

2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180
static void nbd_mcast_index(int index)
{
	struct sk_buff *skb;
	void *msg_head;
	int ret;

	skb = genlmsg_new(nla_total_size(sizeof(u32)), GFP_KERNEL);
	if (!skb)
		return;
	msg_head = genlmsg_put(skb, 0, 0, &nbd_genl_family, 0,
				     NBD_CMD_LINK_DEAD);
	if (!msg_head) {
		nlmsg_free(skb);
		return;
	}
	ret = nla_put_u32(skb, NBD_ATTR_INDEX, index);
	if (ret) {
		nlmsg_free(skb);
		return;
	}
	genlmsg_end(skb, msg_head);
	genlmsg_multicast(&nbd_genl_family, skb, 0, 0, GFP_KERNEL);
}

static void nbd_dead_link_work(struct work_struct *work)
{
	struct link_dead_args *args = container_of(work, struct link_dead_args,
						   work);
	nbd_mcast_index(args->index);
	kfree(args);
}

L
Linus Torvalds 已提交
2181 2182 2183 2184
static int __init nbd_init(void)
{
	int i;

2185
	BUILD_BUG_ON(sizeof(struct nbd_request) != 28);
L
Linus Torvalds 已提交
2186

L
Laurent Vivier 已提交
2187
	if (max_part < 0) {
2188
		printk(KERN_ERR "nbd: max_part must be >= 0\n");
L
Laurent Vivier 已提交
2189 2190 2191 2192
		return -EINVAL;
	}

	part_shift = 0;
2193
	if (max_part > 0) {
L
Laurent Vivier 已提交
2194 2195
		part_shift = fls(max_part);

2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206
		/*
		 * Adjust max_part according to part_shift as it is exported
		 * to user space so that user can know the max number of
		 * partition kernel should be able to manage.
		 *
		 * Note that -1 is required because partition 0 is reserved
		 * for the whole disk.
		 */
		max_part = (1UL << part_shift) - 1;
	}

2207 2208 2209 2210 2211
	if ((1UL << part_shift) > DISK_MAX_PARTS)
		return -EINVAL;

	if (nbds_max > 1UL << (MINORBITS - part_shift))
		return -EINVAL;
2212
	recv_workqueue = alloc_workqueue("knbd-recv",
2213 2214
					 WQ_MEM_RECLAIM | WQ_HIGHPRI |
					 WQ_UNBOUND, 0);
2215 2216
	if (!recv_workqueue)
		return -ENOMEM;
2217

2218 2219
	if (register_blkdev(NBD_MAJOR, "nbd")) {
		destroy_workqueue(recv_workqueue);
2220
		return -EIO;
2221
	}
L
Linus Torvalds 已提交
2222

J
Josef Bacik 已提交
2223 2224 2225 2226 2227
	if (genl_register_family(&nbd_genl_family)) {
		unregister_blkdev(NBD_MAJOR, "nbd");
		destroy_workqueue(recv_workqueue);
		return -EINVAL;
	}
M
Markus Pargmann 已提交
2228 2229
	nbd_dbg_init();

2230 2231 2232 2233 2234 2235
	mutex_lock(&nbd_index_mutex);
	for (i = 0; i < nbds_max; i++)
		nbd_dev_add(i);
	mutex_unlock(&nbd_index_mutex);
	return 0;
}
L
Linus Torvalds 已提交
2236

2237 2238
static int nbd_exit_cb(int id, void *ptr, void *data)
{
J
Josef Bacik 已提交
2239
	struct list_head *list = (struct list_head *)data;
2240
	struct nbd_device *nbd = ptr;
J
Josef Bacik 已提交
2241 2242

	list_add_tail(&nbd->list, list);
L
Linus Torvalds 已提交
2243 2244 2245 2246 2247
	return 0;
}

static void __exit nbd_cleanup(void)
{
J
Josef Bacik 已提交
2248 2249 2250
	struct nbd_device *nbd;
	LIST_HEAD(del_list);

M
Markus Pargmann 已提交
2251 2252
	nbd_dbg_close();

J
Josef Bacik 已提交
2253 2254 2255 2256
	mutex_lock(&nbd_index_mutex);
	idr_for_each(&nbd_index_idr, &nbd_exit_cb, &del_list);
	mutex_unlock(&nbd_index_mutex);

2257 2258 2259 2260
	while (!list_empty(&del_list)) {
		nbd = list_first_entry(&del_list, struct nbd_device, list);
		list_del_init(&nbd->list);
		if (refcount_read(&nbd->refs) != 1)
J
Josef Bacik 已提交
2261 2262 2263 2264
			printk(KERN_ERR "nbd: possibly leaking a device\n");
		nbd_put(nbd);
	}

2265
	idr_destroy(&nbd_index_idr);
J
Josef Bacik 已提交
2266
	genl_unregister_family(&nbd_genl_family);
2267
	destroy_workqueue(recv_workqueue);
L
Linus Torvalds 已提交
2268 2269 2270 2271 2272 2273 2274 2275 2276
	unregister_blkdev(NBD_MAJOR, "nbd");
}

module_init(nbd_init);
module_exit(nbd_cleanup);

MODULE_DESCRIPTION("Network Block Device");
MODULE_LICENSE("GPL");

2277
module_param(nbds_max, int, 0444);
L
Laurent Vivier 已提交
2278 2279
MODULE_PARM_DESC(nbds_max, "number of network block devices to initialize (default: 16)");
module_param(max_part, int, 0444);
2280
MODULE_PARM_DESC(max_part, "number of partitions per device (default: 16)");