virtio_blk.c 20.1 KB
Newer Older
R
Rusty Russell 已提交
1 2
//#define DEBUG
#include <linux/spinlock.h>
3
#include <linux/slab.h>
R
Rusty Russell 已提交
4 5
#include <linux/blkdev.h>
#include <linux/hdreg.h>
6
#include <linux/module.h>
7
#include <linux/mutex.h>
R
Rusty Russell 已提交
8 9
#include <linux/virtio.h>
#include <linux/virtio_blk.h>
10
#include <linux/scatterlist.h>
11
#include <linux/string_helpers.h>
12
#include <scsi/scsi_cmnd.h>
13
#include <linux/idr.h>
J
Jens Axboe 已提交
14 15
#include <linux/blk-mq.h>
#include <linux/numa.h>
16

17
#define PART_BITS 4
R
Rusty Russell 已提交
18

19 20 21
static int major;
static DEFINE_IDA(vd_index_ida);

22
static struct workqueue_struct *virtblk_wq;
23

R
Rusty Russell 已提交
24 25 26 27
struct virtio_blk
{
	struct virtio_device *vdev;
	struct virtqueue *vq;
J
Jens Axboe 已提交
28
	spinlock_t vq_lock;
R
Rusty Russell 已提交
29 30 31 32

	/* The disk structure for the kernel. */
	struct gendisk *disk;

33 34 35
	/* Process context for config space updates */
	struct work_struct config_work;

36 37 38 39 40 41
	/* Lock for config space updates */
	struct mutex config_lock;

	/* enable config space updates */
	bool config_enable;

42 43 44
	/* What host tells us, plus 2 for header & tailer. */
	unsigned int sg_elems;

45 46
	/* Ida index - used to track minor number allocations. */
	int index;
R
Rusty Russell 已提交
47 48 49 50 51 52
};

struct virtblk_req
{
	struct request *req;
	struct virtio_blk_outhdr out_hdr;
53
	struct virtio_scsi_inhdr in_hdr;
54
	u8 status;
55
	struct scatterlist sg[];
R
Rusty Russell 已提交
56 57
};

58 59 60 61 62 63 64 65 66 67 68 69
static inline int virtblk_result(struct virtblk_req *vbr)
{
	switch (vbr->status) {
	case VIRTIO_BLK_S_OK:
		return 0;
	case VIRTIO_BLK_S_UNSUPP:
		return -ENOTTY;
	default:
		return -EIO;
	}
}

70
static int __virtblk_add_req(struct virtqueue *vq,
71 72
			     struct virtblk_req *vbr,
			     struct scatterlist *data_sg,
R
Rusty Russell 已提交
73
			     bool have_data)
74
{
75
	struct scatterlist hdr, status, cmd, sense, inhdr, *sgs[6];
76
	unsigned int num_out = 0, num_in = 0;
77
	int type = vbr->out_hdr.type & ~VIRTIO_BLK_T_OUT;
78 79 80 81

	sg_init_one(&hdr, &vbr->out_hdr, sizeof(vbr->out_hdr));
	sgs[num_out++] = &hdr;

82 83 84 85 86 87 88 89 90 91 92
	/*
	 * If this is a packet command we need a couple of additional headers.
	 * Behind the normal outhdr we put a segment with the scsi command
	 * block, and before the normal inhdr we put the sense data and the
	 * inhdr with additional status information.
	 */
	if (type == VIRTIO_BLK_T_SCSI_CMD) {
		sg_init_one(&cmd, vbr->req->cmd, vbr->req->cmd_len);
		sgs[num_out++] = &cmd;
	}

R
Rusty Russell 已提交
93
	if (have_data) {
94
		if (vbr->out_hdr.type & VIRTIO_BLK_T_OUT)
95
			sgs[num_out++] = data_sg;
96
		else
97 98 99 100 101 102 103 104
			sgs[num_out + num_in++] = data_sg;
	}

	if (type == VIRTIO_BLK_T_SCSI_CMD) {
		sg_init_one(&sense, vbr->req->sense, SCSI_SENSE_BUFFERSIZE);
		sgs[num_out + num_in++] = &sense;
		sg_init_one(&inhdr, &vbr->in_hdr, sizeof(vbr->in_hdr));
		sgs[num_out + num_in++] = &inhdr;
105 106 107 108 109 110
	}

	sg_init_one(&status, &vbr->status, sizeof(vbr->status));
	sgs[num_out + num_in++] = &status;

	return virtqueue_add_sgs(vq, sgs, num_out, num_in, vbr, GFP_ATOMIC);
111 112
}

113
static inline void virtblk_request_done(struct virtblk_req *vbr)
114 115 116 117 118 119 120 121 122 123 124 125
{
	struct request *req = vbr->req;
	int error = virtblk_result(vbr);

	if (req->cmd_type == REQ_TYPE_BLOCK_PC) {
		req->resid_len = vbr->in_hdr.residual;
		req->sense_len = vbr->in_hdr.sense_len;
		req->errors = vbr->in_hdr.errors;
	} else if (req->cmd_type == REQ_TYPE_SPECIAL) {
		req->errors = (error != 0);
	}

J
Jens Axboe 已提交
126
	blk_mq_end_io(req, error);
127 128 129
}

static void virtblk_done(struct virtqueue *vq)
R
Rusty Russell 已提交
130 131
{
	struct virtio_blk *vblk = vq->vdev->priv;
J
Jens Axboe 已提交
132
	bool req_done = false;
R
Rusty Russell 已提交
133 134
	struct virtblk_req *vbr;
	unsigned long flags;
135
	unsigned int len;
R
Rusty Russell 已提交
136

J
Jens Axboe 已提交
137
	spin_lock_irqsave(&vblk->vq_lock, flags);
138 139 140
	do {
		virtqueue_disable_cb(vq);
		while ((vbr = virtqueue_get_buf(vblk->vq, &len)) != NULL) {
J
Jens Axboe 已提交
141 142
			virtblk_request_done(vbr);
			req_done = true;
143
		}
144 145
		if (unlikely(virtqueue_is_broken(vq)))
			break;
146
	} while (!virtqueue_enable_cb(vq));
J
Jens Axboe 已提交
147 148
	spin_unlock_irqrestore(&vblk->vq_lock, flags);

R
Rusty Russell 已提交
149
	/* In case queue is stopped waiting for more buffers. */
150
	if (req_done)
J
Jens Axboe 已提交
151
		blk_mq_start_stopped_hw_queues(vblk->disk->queue);
152 153
}

J
Jens Axboe 已提交
154
static int virtio_queue_rq(struct blk_mq_hw_ctx *hctx, struct request *req)
R
Rusty Russell 已提交
155
{
J
Jens Axboe 已提交
156 157 158
	struct virtio_blk *vblk = hctx->queue->queuedata;
	struct virtblk_req *vbr = req->special;
	unsigned long flags;
159
	unsigned int num;
J
Jens Axboe 已提交
160
	const bool last = (req->cmd_flags & REQ_END) != 0;
R
Rusty Russell 已提交
161

J
Jens Axboe 已提交
162
	BUG_ON(req->nr_phys_segments + 2 > vblk->sg_elems);
R
Rusty Russell 已提交
163 164

	vbr->req = req;
165 166
	if (req->cmd_flags & REQ_FLUSH) {
		vbr->out_hdr.type = VIRTIO_BLK_T_FLUSH;
167 168
		vbr->out_hdr.sector = 0;
		vbr->out_hdr.ioprio = req_get_ioprio(vbr->req);
169 170 171 172 173 174 175 176 177
	} else {
		switch (req->cmd_type) {
		case REQ_TYPE_FS:
			vbr->out_hdr.type = 0;
			vbr->out_hdr.sector = blk_rq_pos(vbr->req);
			vbr->out_hdr.ioprio = req_get_ioprio(vbr->req);
			break;
		case REQ_TYPE_BLOCK_PC:
			vbr->out_hdr.type = VIRTIO_BLK_T_SCSI_CMD;
178 179 180
			vbr->out_hdr.sector = 0;
			vbr->out_hdr.ioprio = req_get_ioprio(vbr->req);
			break;
181 182 183 184 185 186 187 188
		case REQ_TYPE_SPECIAL:
			vbr->out_hdr.type = VIRTIO_BLK_T_GET_ID;
			vbr->out_hdr.sector = 0;
			vbr->out_hdr.ioprio = req_get_ioprio(vbr->req);
			break;
		default:
			/* We don't put anything else in the queue. */
			BUG();
189
		}
R
Rusty Russell 已提交
190 191
	}

J
Jens Axboe 已提交
192
	num = blk_rq_map_sg(hctx->queue, vbr->req, vbr->sg);
193
	if (num) {
194
		if (rq_data_dir(vbr->req) == WRITE)
195
			vbr->out_hdr.type |= VIRTIO_BLK_T_OUT;
196
		else
197
			vbr->out_hdr.type |= VIRTIO_BLK_T_IN;
R
Rusty Russell 已提交
198 199
	}

J
Jens Axboe 已提交
200 201 202 203
	spin_lock_irqsave(&vblk->vq_lock, flags);
	if (__virtblk_add_req(vblk->vq, vbr, vbr->sg, num) < 0) {
		spin_unlock_irqrestore(&vblk->vq_lock, flags);
		blk_mq_stop_hw_queue(hctx);
204
		virtqueue_kick(vblk->vq);
J
Jens Axboe 已提交
205
		return BLK_MQ_RQ_QUEUE_BUSY;
206
	}
J
Jens Axboe 已提交
207
	spin_unlock_irqrestore(&vblk->vq_lock, flags);
208

J
Jens Axboe 已提交
209 210 211
	if (last)
		virtqueue_kick(vblk->vq);
	return BLK_MQ_RQ_QUEUE_OK;
212 213
}

214 215 216 217 218 219 220
/* return id (s/n) string for *disk to *id_str
 */
static int virtblk_get_id(struct gendisk *disk, char *id_str)
{
	struct virtio_blk *vblk = disk->private_data;
	struct request *req;
	struct bio *bio;
M
Mike Snitzer 已提交
221
	int err;
222 223 224 225 226 227 228 229 230 231 232 233 234

	bio = bio_map_kern(vblk->disk->queue, id_str, VIRTIO_BLK_ID_BYTES,
			   GFP_KERNEL);
	if (IS_ERR(bio))
		return PTR_ERR(bio);

	req = blk_make_request(vblk->disk->queue, bio, GFP_KERNEL);
	if (IS_ERR(req)) {
		bio_put(bio);
		return PTR_ERR(req);
	}

	req->cmd_type = REQ_TYPE_SPECIAL;
M
Mike Snitzer 已提交
235 236 237 238
	err = blk_execute_rq(vblk->disk->queue, vblk->disk, req, false);
	blk_put_request(req);

	return err;
239 240
}

241 242
static int virtblk_ioctl(struct block_device *bdev, fmode_t mode,
			     unsigned int cmd, unsigned long data)
R
Rusty Russell 已提交
243
{
244 245 246 247 248 249 250
	struct gendisk *disk = bdev->bd_disk;
	struct virtio_blk *vblk = disk->private_data;

	/*
	 * Only allow the generic SCSI ioctls if the host can support it.
	 */
	if (!virtio_has_feature(vblk->vdev, VIRTIO_BLK_F_SCSI))
251
		return -ENOTTY;
252

253 254
	return scsi_cmd_blk_ioctl(bdev, mode, cmd,
				  (void __user *)data);
R
Rusty Russell 已提交
255 256
}

257 258 259
/* We provide getgeo only to please some old bootloader/partitioning tools */
static int virtblk_getgeo(struct block_device *bd, struct hd_geometry *geo)
{
260 261 262
	struct virtio_blk *vblk = bd->bd_disk->private_data;

	/* see if the host passed in geometry config */
263 264 265 266 267 268 269
	if (virtio_has_feature(vblk->vdev, VIRTIO_BLK_F_GEOMETRY)) {
		virtio_cread(vblk->vdev, struct virtio_blk_config,
			     geometry.cylinders, &geo->cylinders);
		virtio_cread(vblk->vdev, struct virtio_blk_config,
			     geometry.heads, &geo->heads);
		virtio_cread(vblk->vdev, struct virtio_blk_config,
			     geometry.sectors, &geo->sectors);
270 271 272 273 274 275
	} else {
		/* some standard values, similar to sd */
		geo->heads = 1 << 6;
		geo->sectors = 1 << 5;
		geo->cylinders = get_capacity(bd->bd_disk) >> 11;
	}
276 277 278
	return 0;
}

279
static const struct block_device_operations virtblk_fops = {
280
	.ioctl  = virtblk_ioctl,
281 282
	.owner  = THIS_MODULE,
	.getgeo = virtblk_getgeo,
R
Rusty Russell 已提交
283 284
};

285 286 287 288 289
static int index_to_minor(int index)
{
	return index << PART_BITS;
}

290 291 292 293 294
static int minor_to_index(int minor)
{
	return minor >> PART_BITS;
}

295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315
static ssize_t virtblk_serial_show(struct device *dev,
				struct device_attribute *attr, char *buf)
{
	struct gendisk *disk = dev_to_disk(dev);
	int err;

	/* sysfs gives us a PAGE_SIZE buffer */
	BUILD_BUG_ON(PAGE_SIZE < VIRTIO_BLK_ID_BYTES);

	buf[VIRTIO_BLK_ID_BYTES] = '\0';
	err = virtblk_get_id(disk, buf);
	if (!err)
		return strlen(buf);

	if (err == -EIO) /* Unsupported? Make it empty. */
		return 0;

	return err;
}
DEVICE_ATTR(serial, S_IRUGO, virtblk_serial_show, NULL);

316 317 318 319 320 321 322
static void virtblk_config_changed_work(struct work_struct *work)
{
	struct virtio_blk *vblk =
		container_of(work, struct virtio_blk, config_work);
	struct virtio_device *vdev = vblk->vdev;
	struct request_queue *q = vblk->disk->queue;
	char cap_str_2[10], cap_str_10[10];
323
	char *envp[] = { "RESIZE=1", NULL };
324 325
	u64 capacity, size;

326 327 328 329
	mutex_lock(&vblk->config_lock);
	if (!vblk->config_enable)
		goto done;

330
	/* Host must always specify the capacity. */
331
	virtio_cread(vdev, struct virtio_blk_config, capacity, &capacity);
332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350

	/* If capacity is too big, truncate with warning. */
	if ((sector_t)capacity != capacity) {
		dev_warn(&vdev->dev, "Capacity %llu too large: truncating\n",
			 (unsigned long long)capacity);
		capacity = (sector_t)-1;
	}

	size = capacity * queue_logical_block_size(q);
	string_get_size(size, STRING_UNITS_2, cap_str_2, sizeof(cap_str_2));
	string_get_size(size, STRING_UNITS_10, cap_str_10, sizeof(cap_str_10));

	dev_notice(&vdev->dev,
		  "new size: %llu %d-byte logical blocks (%s/%s)\n",
		  (unsigned long long)capacity,
		  queue_logical_block_size(q),
		  cap_str_10, cap_str_2);

	set_capacity(vblk->disk, capacity);
351
	revalidate_disk(vblk->disk);
352
	kobject_uevent_env(&disk_to_dev(vblk->disk)->kobj, KOBJ_CHANGE, envp);
353 354
done:
	mutex_unlock(&vblk->config_lock);
355 356 357 358 359 360 361 362 363
}

static void virtblk_config_changed(struct virtio_device *vdev)
{
	struct virtio_blk *vblk = vdev->priv;

	queue_work(virtblk_wq, &vblk->config_work);
}

364 365 366 367 368
static int init_vq(struct virtio_blk *vblk)
{
	int err = 0;

	/* We expect one virtqueue, for output. */
369
	vblk->vq = virtio_find_single_vq(vblk->vdev, virtblk_done, "requests");
370 371 372 373 374 375
	if (IS_ERR(vblk->vq))
		err = PTR_ERR(vblk->vq);

	return err;
}

376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403
/*
 * Legacy naming scheme used for virtio devices.  We are stuck with it for
 * virtio blk but don't ever use it for any new driver.
 */
static int virtblk_name_format(char *prefix, int index, char *buf, int buflen)
{
	const int base = 'z' - 'a' + 1;
	char *begin = buf + strlen(prefix);
	char *end = buf + buflen;
	char *p;
	int unit;

	p = end - 1;
	*p = '\0';
	unit = base;
	do {
		if (p == begin)
			return -EINVAL;
		*--p = 'a' + (index % unit);
		index = (index / unit) - 1;
	} while (index >= 0);

	memmove(begin, p, end - p);
	memcpy(buf, prefix, strlen(prefix));

	return 0;
}

404 405 406 407 408
static int virtblk_get_cache_mode(struct virtio_device *vdev)
{
	u8 writeback;
	int err;

409 410 411
	err = virtio_cread_feature(vdev, VIRTIO_BLK_F_CONFIG_WCE,
				   struct virtio_blk_config, wce,
				   &writeback);
412 413 414 415 416 417 418 419 420 421 422
	if (err)
		writeback = virtio_has_feature(vdev, VIRTIO_BLK_F_WCE);

	return writeback;
}

static void virtblk_update_cache_mode(struct virtio_device *vdev)
{
	u8 writeback = virtblk_get_cache_mode(vdev);
	struct virtio_blk *vblk = vdev->priv;

423
	if (writeback)
424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451
		blk_queue_flush(vblk->disk->queue, REQ_FLUSH);
	else
		blk_queue_flush(vblk->disk->queue, 0);

	revalidate_disk(vblk->disk);
}

static const char *const virtblk_cache_types[] = {
	"write through", "write back"
};

static ssize_t
virtblk_cache_type_store(struct device *dev, struct device_attribute *attr,
			 const char *buf, size_t count)
{
	struct gendisk *disk = dev_to_disk(dev);
	struct virtio_blk *vblk = disk->private_data;
	struct virtio_device *vdev = vblk->vdev;
	int i;

	BUG_ON(!virtio_has_feature(vblk->vdev, VIRTIO_BLK_F_CONFIG_WCE));
	for (i = ARRAY_SIZE(virtblk_cache_types); --i >= 0; )
		if (sysfs_streq(buf, virtblk_cache_types[i]))
			break;

	if (i < 0)
		return -EINVAL;

452
	virtio_cwrite8(vdev, offsetof(struct virtio_blk_config, wce), i);
453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475
	virtblk_update_cache_mode(vdev);
	return count;
}

static ssize_t
virtblk_cache_type_show(struct device *dev, struct device_attribute *attr,
			 char *buf)
{
	struct gendisk *disk = dev_to_disk(dev);
	struct virtio_blk *vblk = disk->private_data;
	u8 writeback = virtblk_get_cache_mode(vblk->vdev);

	BUG_ON(writeback >= ARRAY_SIZE(virtblk_cache_types));
	return snprintf(buf, 40, "%s\n", virtblk_cache_types[writeback]);
}

static const struct device_attribute dev_attr_cache_type_ro =
	__ATTR(cache_type, S_IRUGO,
	       virtblk_cache_type_show, NULL);
static const struct device_attribute dev_attr_cache_type_rw =
	__ATTR(cache_type, S_IRUGO|S_IWUSR,
	       virtblk_cache_type_show, virtblk_cache_type_store);

J
Jens Axboe 已提交
476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499
static struct blk_mq_ops virtio_mq_ops = {
	.queue_rq	= virtio_queue_rq,
	.map_queue	= blk_mq_map_queue,
	.alloc_hctx	= blk_mq_alloc_single_hw_queue,
	.free_hctx	= blk_mq_free_single_hw_queue,
};

static struct blk_mq_reg virtio_mq_reg = {
	.ops		= &virtio_mq_ops,
	.nr_hw_queues	= 1,
	.queue_depth	= 64,
	.numa_node	= NUMA_NO_NODE,
	.flags		= BLK_MQ_F_SHOULD_MERGE,
};

static void virtblk_init_vbr(void *data, struct blk_mq_hw_ctx *hctx,
			     struct request *rq, unsigned int nr)
{
	struct virtio_blk *vblk = data;
	struct virtblk_req *vbr = rq->special;

	sg_init_table(vbr->sg, vblk->sg_elems);
}

500
static int virtblk_probe(struct virtio_device *vdev)
R
Rusty Russell 已提交
501 502
{
	struct virtio_blk *vblk;
503
	struct request_queue *q;
504
	int err, index;
505

R
Rusty Russell 已提交
506
	u64 cap;
507 508 509
	u32 v, blk_size, sg_elems, opt_io_size;
	u16 min_io_size;
	u8 physical_block_exp, alignment_offset;
R
Rusty Russell 已提交
510

511 512 513 514 515
	err = ida_simple_get(&vd_index_ida, 0, minor_to_index(1 << MINORBITS),
			     GFP_KERNEL);
	if (err < 0)
		goto out;
	index = err;
516

517
	/* We need to know how many segments before we allocate. */
518 519 520
	err = virtio_cread_feature(vdev, VIRTIO_BLK_F_SEG_MAX,
				   struct virtio_blk_config, seg_max,
				   &sg_elems);
521 522 523

	/* We need at least one SG element, whatever they say. */
	if (err || !sg_elems)
524 525 526 527
		sg_elems = 1;

	/* We need an extra sg elements at head and tail. */
	sg_elems += 2;
J
Jens Axboe 已提交
528
	vdev->priv = vblk = kmalloc(sizeof(*vblk), GFP_KERNEL);
R
Rusty Russell 已提交
529 530
	if (!vblk) {
		err = -ENOMEM;
531
		goto out_free_index;
R
Rusty Russell 已提交
532 533 534
	}

	vblk->vdev = vdev;
535
	vblk->sg_elems = sg_elems;
536
	mutex_init(&vblk->config_lock);
537

538
	INIT_WORK(&vblk->config_work, virtblk_config_changed_work);
539
	vblk->config_enable = true;
R
Rusty Russell 已提交
540

541 542
	err = init_vq(vblk);
	if (err)
R
Rusty Russell 已提交
543
		goto out_free_vblk;
J
Jens Axboe 已提交
544
	spin_lock_init(&vblk->vq_lock);
R
Rusty Russell 已提交
545 546

	/* FIXME: How many partitions?  How long is a piece of string? */
547
	vblk->disk = alloc_disk(1 << PART_BITS);
R
Rusty Russell 已提交
548 549
	if (!vblk->disk) {
		err = -ENOMEM;
J
Jens Axboe 已提交
550
		goto out_free_vq;
R
Rusty Russell 已提交
551 552
	}

J
Jens Axboe 已提交
553 554 555 556 557
	virtio_mq_reg.cmd_size =
		sizeof(struct virtblk_req) +
		sizeof(struct scatterlist) * sg_elems;

	q = vblk->disk->queue = blk_mq_init_queue(&virtio_mq_reg, vblk);
558
	if (!q) {
R
Rusty Russell 已提交
559 560 561 562
		err = -ENOMEM;
		goto out_put_disk;
	}

J
Jens Axboe 已提交
563 564
	blk_mq_init_commands(q, virtblk_init_vbr, vblk);

565
	q->queuedata = vblk;
566

567
	virtblk_name_format("vd", index, vblk->disk->disk_name, DISK_NAME_LEN);
568

R
Rusty Russell 已提交
569
	vblk->disk->major = major;
570
	vblk->disk->first_minor = index_to_minor(index);
R
Rusty Russell 已提交
571 572
	vblk->disk->private_data = vblk;
	vblk->disk->fops = &virtblk_fops;
573
	vblk->disk->driverfs_dev = &vdev->dev;
574
	vblk->index = index;
575

576
	/* configure queue flush support */
577
	virtblk_update_cache_mode(vdev);
R
Rusty Russell 已提交
578

579 580 581 582
	/* If disk is read-only in the host, the guest should obey */
	if (virtio_has_feature(vdev, VIRTIO_BLK_F_RO))
		set_disk_ro(vblk->disk, 1);

583
	/* Host must always specify the capacity. */
584
	virtio_cread(vdev, struct virtio_blk_config, capacity, &cap);
R
Rusty Russell 已提交
585 586 587 588 589 590 591 592 593

	/* If capacity is too big, truncate with warning. */
	if ((sector_t)cap != cap) {
		dev_warn(&vdev->dev, "Capacity %llu too large: truncating\n",
			 (unsigned long long)cap);
		cap = (sector_t)-1;
	}
	set_capacity(vblk->disk, cap);

594
	/* We can handle whatever the host told us to handle. */
595
	blk_queue_max_segments(q, vblk->sg_elems-2);
596

597
	/* No need to bounce any requests */
598
	blk_queue_bounce_limit(q, BLK_BOUNCE_ANY);
599

600
	/* No real sector limit. */
601
	blk_queue_max_hw_sectors(q, -1U);
602

603 604
	/* Host can optionally specify maximum segment size and number of
	 * segments. */
605 606
	err = virtio_cread_feature(vdev, VIRTIO_BLK_F_SIZE_MAX,
				   struct virtio_blk_config, size_max, &v);
R
Rusty Russell 已提交
607
	if (!err)
608
		blk_queue_max_segment_size(q, v);
609
	else
610
		blk_queue_max_segment_size(q, -1U);
R
Rusty Russell 已提交
611

612
	/* Host can optionally specify the block size of the device */
613 614 615
	err = virtio_cread_feature(vdev, VIRTIO_BLK_F_BLK_SIZE,
				   struct virtio_blk_config, blk_size,
				   &blk_size);
616
	if (!err)
617 618 619 620 621
		blk_queue_logical_block_size(q, blk_size);
	else
		blk_size = queue_logical_block_size(q);

	/* Use topology information if available */
622 623 624
	err = virtio_cread_feature(vdev, VIRTIO_BLK_F_TOPOLOGY,
				   struct virtio_blk_config, physical_block_exp,
				   &physical_block_exp);
625 626 627 628
	if (!err && physical_block_exp)
		blk_queue_physical_block_size(q,
				blk_size * (1 << physical_block_exp));

629 630 631
	err = virtio_cread_feature(vdev, VIRTIO_BLK_F_TOPOLOGY,
				   struct virtio_blk_config, alignment_offset,
				   &alignment_offset);
632 633 634
	if (!err && alignment_offset)
		blk_queue_alignment_offset(q, blk_size * alignment_offset);

635 636 637
	err = virtio_cread_feature(vdev, VIRTIO_BLK_F_TOPOLOGY,
				   struct virtio_blk_config, min_io_size,
				   &min_io_size);
638 639 640
	if (!err && min_io_size)
		blk_queue_io_min(q, blk_size * min_io_size);

641 642 643
	err = virtio_cread_feature(vdev, VIRTIO_BLK_F_TOPOLOGY,
				   struct virtio_blk_config, opt_io_size,
				   &opt_io_size);
644 645 646
	if (!err && opt_io_size)
		blk_queue_io_opt(q, blk_size * opt_io_size);

R
Rusty Russell 已提交
647
	add_disk(vblk->disk);
648 649 650 651
	err = device_create_file(disk_to_dev(vblk->disk), &dev_attr_serial);
	if (err)
		goto out_del_disk;

652 653 654 655 656 657 658 659
	if (virtio_has_feature(vdev, VIRTIO_BLK_F_CONFIG_WCE))
		err = device_create_file(disk_to_dev(vblk->disk),
					 &dev_attr_cache_type_rw);
	else
		err = device_create_file(disk_to_dev(vblk->disk),
					 &dev_attr_cache_type_ro);
	if (err)
		goto out_del_disk;
R
Rusty Russell 已提交
660 661
	return 0;

662 663 664
out_del_disk:
	del_gendisk(vblk->disk);
	blk_cleanup_queue(vblk->disk->queue);
R
Rusty Russell 已提交
665 666 667
out_put_disk:
	put_disk(vblk->disk);
out_free_vq:
668
	vdev->config->del_vqs(vdev);
R
Rusty Russell 已提交
669 670
out_free_vblk:
	kfree(vblk);
671 672
out_free_index:
	ida_simple_remove(&vd_index_ida, index);
R
Rusty Russell 已提交
673 674 675 676
out:
	return err;
}

677
static void virtblk_remove(struct virtio_device *vdev)
R
Rusty Russell 已提交
678 679
{
	struct virtio_blk *vblk = vdev->priv;
680
	int index = vblk->index;
681
	int refc;
R
Rusty Russell 已提交
682

683 684 685 686
	/* Prevent config work handler from accessing the device. */
	mutex_lock(&vblk->config_lock);
	vblk->config_enable = false;
	mutex_unlock(&vblk->config_lock);
687

688
	del_gendisk(vblk->disk);
689
	blk_cleanup_queue(vblk->disk->queue);
690

R
Rusty Russell 已提交
691 692 693
	/* Stop all the virtqueues. */
	vdev->config->reset(vdev);

694 695
	flush_work(&vblk->config_work);

696
	refc = atomic_read(&disk_to_dev(vblk->disk)->kobj.kref.refcount);
R
Rusty Russell 已提交
697
	put_disk(vblk->disk);
698
	vdev->config->del_vqs(vdev);
R
Rusty Russell 已提交
699
	kfree(vblk);
700 701 702 703

	/* Only free device id if we don't have any users */
	if (refc == 1)
		ida_simple_remove(&vd_index_ida, index);
R
Rusty Russell 已提交
704 705
}

706
#ifdef CONFIG_PM_SLEEP
707 708 709 710 711 712 713 714 715 716 717 718 719 720
static int virtblk_freeze(struct virtio_device *vdev)
{
	struct virtio_blk *vblk = vdev->priv;

	/* Ensure we don't receive any more interrupts */
	vdev->config->reset(vdev);

	/* Prevent config work handler from accessing the device. */
	mutex_lock(&vblk->config_lock);
	vblk->config_enable = false;
	mutex_unlock(&vblk->config_lock);

	flush_work(&vblk->config_work);

J
Jens Axboe 已提交
721
	blk_mq_stop_hw_queues(vblk->disk->queue);
722 723 724 725 726 727 728 729 730 731 732 733

	vdev->config->del_vqs(vdev);
	return 0;
}

static int virtblk_restore(struct virtio_device *vdev)
{
	struct virtio_blk *vblk = vdev->priv;
	int ret;

	vblk->config_enable = true;
	ret = init_vq(vdev->priv);
J
Jens Axboe 已提交
734 735 736
	if (!ret)
		blk_mq_start_stopped_hw_queues(vblk->disk->queue);

737 738 739 740
	return ret;
}
#endif

741
static const struct virtio_device_id id_table[] = {
R
Rusty Russell 已提交
742 743 744 745
	{ VIRTIO_ID_BLOCK, VIRTIO_DEV_ANY_ID },
	{ 0 },
};

746
static unsigned int features[] = {
747 748
	VIRTIO_BLK_F_SEG_MAX, VIRTIO_BLK_F_SIZE_MAX, VIRTIO_BLK_F_GEOMETRY,
	VIRTIO_BLK_F_RO, VIRTIO_BLK_F_BLK_SIZE, VIRTIO_BLK_F_SCSI,
749
	VIRTIO_BLK_F_WCE, VIRTIO_BLK_F_TOPOLOGY, VIRTIO_BLK_F_CONFIG_WCE
750 751
};

752
static struct virtio_driver virtio_blk = {
753 754 755 756 757 758
	.feature_table		= features,
	.feature_table_size	= ARRAY_SIZE(features),
	.driver.name		= KBUILD_MODNAME,
	.driver.owner		= THIS_MODULE,
	.id_table		= id_table,
	.probe			= virtblk_probe,
759
	.remove			= virtblk_remove,
760
	.config_changed		= virtblk_config_changed,
761
#ifdef CONFIG_PM_SLEEP
762 763 764
	.freeze			= virtblk_freeze,
	.restore		= virtblk_restore,
#endif
R
Rusty Russell 已提交
765 766 767 768
};

static int __init init(void)
{
769 770 771 772 773 774
	int error;

	virtblk_wq = alloc_workqueue("virtio-blk", 0, 0);
	if (!virtblk_wq)
		return -ENOMEM;

775
	major = register_blkdev(0, "virtblk");
776 777 778 779 780 781 782 783 784 785 786 787 788 789 790
	if (major < 0) {
		error = major;
		goto out_destroy_workqueue;
	}

	error = register_virtio_driver(&virtio_blk);
	if (error)
		goto out_unregister_blkdev;
	return 0;

out_unregister_blkdev:
	unregister_blkdev(major, "virtblk");
out_destroy_workqueue:
	destroy_workqueue(virtblk_wq);
	return error;
R
Rusty Russell 已提交
791 792 793 794
}

static void __exit fini(void)
{
795
	unregister_blkdev(major, "virtblk");
R
Rusty Russell 已提交
796
	unregister_virtio_driver(&virtio_blk);
797
	destroy_workqueue(virtblk_wq);
R
Rusty Russell 已提交
798 799 800 801 802 803 804
}
module_init(init);
module_exit(fini);

MODULE_DEVICE_TABLE(virtio, id_table);
MODULE_DESCRIPTION("Virtio block driver");
MODULE_LICENSE("GPL");