[linux-2.6-block.git] / tools / virtio / virtio_test.c

// SPDX-License-Identifier: GPL-2.0
#define _GNU_SOURCE
#include <getopt.h>
#include <string.h>
#include <poll.h>
#include <sys/eventfd.h>
#include <stdlib.h>
#include <assert.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <fcntl.h>
#include <stdbool.h>
#include <linux/virtio_types.h>
#include <linux/vhost.h>
#include <linux/virtio.h>
#include <linux/virtio_ring.h>
#include "../../drivers/vhost/test.h"

/* Unused */
void *__kmalloc_fake, *__kfree_ignore_start, *__kfree_ignore_end;

struct vq_info {
	int kick;
	int call;
	int num;
	int idx;
	void *ring;
	/* copy used for control */
	struct vring vring;
	struct virtqueue *vq;
};

struct vdev_info {
	struct virtio_device vdev;
	int control;
	struct pollfd fds[1];
	struct vq_info vqs[1];
	int nvqs;
	void *buf;
	size_t buf_size;
	struct vhost_memory *mem;
};

bool vq_notify(struct virtqueue *vq)
{
	struct vq_info *info = vq->priv;
	unsigned long long v = 1;
	int r;
	r = write(info->kick, &v, sizeof v);
	assert(r == sizeof v);
	return true;
}

void vq_callback(struct virtqueue *vq)
{
}


void vhost_vq_setup(struct vdev_info *dev, struct vq_info *info)
{
	struct vhost_vring_state state = { .index = info->idx };
	struct vhost_vring_file file = { .index = info->idx };
	unsigned long long features = dev->vdev.features;
	struct vhost_vring_addr addr = {
		.index = info->idx,
		.desc_user_addr = (uint64_t)(unsigned long)info->vring.desc,
		.avail_user_addr = (uint64_t)(unsigned long)info->vring.avail,
		.used_user_addr = (uint64_t)(unsigned long)info->vring.used,
	};
	int r;
	r = ioctl(dev->control, VHOST_SET_FEATURES, &features);
	assert(r >= 0);
	state.num = info->vring.num;
	r = ioctl(dev->control, VHOST_SET_VRING_NUM, &state);
	assert(r >= 0);
	state.num = 0;
	r = ioctl(dev->control, VHOST_SET_VRING_BASE, &state);
	assert(r >= 0);
	r = ioctl(dev->control, VHOST_SET_VRING_ADDR, &addr);
	assert(r >= 0);
	file.fd = info->kick;
	r = ioctl(dev->control, VHOST_SET_VRING_KICK, &file);
	assert(r >= 0);
	file.fd = info->call;
	r = ioctl(dev->control, VHOST_SET_VRING_CALL, &file);
	assert(r >= 0);
}

static void vq_info_add(struct vdev_info *dev, int num)
{
	struct vq_info *info = &dev->vqs[dev->nvqs];
	int r;
	info->idx = dev->nvqs;
	info->kick = eventfd(0, EFD_NONBLOCK);
	info->call = eventfd(0, EFD_NONBLOCK);
	r = posix_memalign(&info->ring, 4096, vring_size(num, 4096));
	assert(r >= 0);
	memset(info->ring, 0, vring_size(num, 4096));
	vring_init(&info->vring, num, info->ring, 4096);
	info->vq = vring_new_virtqueue(info->idx,
				       info->vring.num, 4096, &dev->vdev,
				       true, false, info->ring,
				       vq_notify, vq_callback, "test");
	assert(info->vq);
	info->vq->priv = info;
	vhost_vq_setup(dev, info);
	dev->fds[info->idx].fd = info->call;
	dev->fds[info->idx].events = POLLIN;
	dev->nvqs++;
}

static void vdev_info_init(struct vdev_info* dev, unsigned long long features)
{
	int r;
	memset(dev, 0, sizeof *dev);
	dev->vdev.features = features;
	dev->buf_size = 1024;
	dev->buf = malloc(dev->buf_size);
	assert(dev->buf);
        dev->control = open("/dev/vhost-test", O_RDWR);
	assert(dev->control >= 0);
	r = ioctl(dev->control, VHOST_SET_OWNER, NULL);
	assert(r >= 0);
	dev->mem = malloc(offsetof(struct vhost_memory, regions) +
			  sizeof dev->mem->regions[0]);
	assert(dev->mem);
	memset(dev->mem, 0, offsetof(struct vhost_memory, regions) +
                          sizeof dev->mem->regions[0]);
	dev->mem->nregions = 1;
	dev->mem->regions[0].guest_phys_addr = (long)dev->buf;
	dev->mem->regions[0].userspace_addr = (long)dev->buf;
	dev->mem->regions[0].memory_size = dev->buf_size;
	r = ioctl(dev->control, VHOST_SET_MEM_TABLE, dev->mem);
	assert(r >= 0);
}

/* TODO: this is pretty bad: we get a cache line bounce
 * for the wait queue on poll and another one on read,
 * plus the read which is there just to clear the
 * current state. */
static void wait_for_interrupt(struct vdev_info *dev)
{
	int i;
	unsigned long long val;
	poll(dev->fds, dev->nvqs, -1);
	for (i = 0; i < dev->nvqs; ++i)
		if (dev->fds[i].revents & POLLIN) {
			read(dev->fds[i].fd, &val, sizeof val);
		}
}

static void run_test(struct vdev_info *dev, struct vq_info *vq,
		     bool delayed, int bufs)
{
	struct scatterlist sl;
	long started = 0, completed = 0;
	long completed_before;
	int r, test = 1;
	unsigned len;
	long long spurious = 0;
	r = ioctl(dev->control, VHOST_TEST_RUN, &test);
	assert(r >= 0);
	for (;;) {
		virtqueue_disable_cb(vq->vq);
		completed_before = completed;
		do {
			if (started < bufs) {
				sg_init_one(&sl, dev->buf, dev->buf_size);
				r = virtqueue_add_outbuf(vq->vq, &sl, 1,
							 dev->buf + started,
							 GFP_ATOMIC);
				if (likely(r == 0)) {
					++started;
					if (unlikely(!virtqueue_kick(vq->vq)))
						r = -1;
				}
			} else
				r = -1;

			/* Flush out completed bufs if any */
			if (virtqueue_get_buf(vq->vq, &len)) {
				++completed;
				r = 0;
			}

		} while (r == 0);
		if (completed == completed_before)
			++spurious;
		assert(completed <= bufs);
		assert(started <= bufs);
		if (completed == bufs)
			break;
		if (delayed) {
			if (virtqueue_enable_cb_delayed(vq->vq))
				wait_for_interrupt(dev);
		} else {
			if (virtqueue_enable_cb(vq->vq))
				wait_for_interrupt(dev);
		}
	}
	test = 0;
	r = ioctl(dev->control, VHOST_TEST_RUN, &test);
	assert(r >= 0);
	fprintf(stderr, "spurious wakeups: 0x%llx\n", spurious);
}

const char optstring[] = "h";
const struct option longopts[] = {
	{
		.name = "help",
		.val = 'h',
	},
	{
		.name = "event-idx",
		.val = 'E',
	},
	{
		.name = "no-event-idx",
		.val = 'e',
	},
	{
		.name = "indirect",
		.val = 'I',
	},
	{
		.name = "no-indirect",
		.val = 'i',
	},
	{
		.name = "virtio-1",
		.val = '1',
	},
	{
		.name = "no-virtio-1",
		.val = '0',
	},
	{
		.name = "delayed-interrupt",
		.val = 'D',
	},
	{
		.name = "no-delayed-interrupt",
		.val = 'd',
	},
	{
	}
};

static void help(void)
{
	fprintf(stderr, "Usage: virtio_test [--help]"
		" [--no-indirect]"
		" [--no-event-idx]"
		" [--no-virtio-1]"
		" [--delayed-interrupt]"
		"\n");
}

int main(int argc, char **argv)
{
	struct vdev_info dev;
	unsigned long long features = (1ULL << VIRTIO_RING_F_INDIRECT_DESC) |
		(1ULL << VIRTIO_RING_F_EVENT_IDX) | (1ULL << VIRTIO_F_VERSION_1);
	int o;
	bool delayed = false;

	for (;;) {
		o = getopt_long(argc, argv, optstring, longopts, NULL);
		switch (o) {
		case -1:
			goto done;
		case '?':
			help();
			exit(2);
		case 'e':
			features &= ~(1ULL << VIRTIO_RING_F_EVENT_IDX);
			break;
		case 'h':
			help();
			goto done;
		case 'i':
			features &= ~(1ULL << VIRTIO_RING_F_INDIRECT_DESC);
			break;
		case '0':
			features &= ~(1ULL << VIRTIO_F_VERSION_1);
			break;
		case 'D':
			delayed = true;
			break;
		default:
			assert(0);
			break;
		}
	}

done:
	vdev_info_init(&dev, features);
	vq_info_add(&dev, 256);
	run_test(&dev, &dev.vqs[0], delayed, 0x100000);
	return 0;
}
Commit	Line	Data
b2441318	1	// SPDX-License-Identifier: GPL-2.0
4e53f78e MT	2	#define _GNU_SOURCE
	3	#include <getopt.h>
	4	#include <string.h>
	5	#include <poll.h>
	6	#include <sys/eventfd.h>
	7	#include <stdlib.h>
	8	#include <assert.h>
	9	#include <unistd.h>
	10	#include <sys/ioctl.h>
	11	#include <sys/stat.h>
	12	#include <sys/types.h>
	13	#include <fcntl.h>
61d0b5a4	14	#include <stdbool.h>
2d7ce0e8	15	#include <linux/virtio_types.h>
4e53f78e MT	16	#include <linux/vhost.h>
	17	#include <linux/virtio.h>
	18	#include <linux/virtio_ring.h>
	19	#include "../../drivers/vhost/test.h"
	20
61d0b5a4 RR	21	/* Unused */
	22	void __kmalloc_fake, __kfree_ignore_start, *__kfree_ignore_end;
	23
4e53f78e MT	24	struct vq_info {
	25	int kick;
	26	int call;
	27	int num;
	28	int idx;
	29	void *ring;
	30	/* copy used for control */
	31	struct vring vring;
	32	struct virtqueue *vq;
	33	};
	34
	35	struct vdev_info {
	36	struct virtio_device vdev;
	37	int control;
	38	struct pollfd fds[1];
	39	struct vq_info vqs[1];
	40	int nvqs;
	41	void *buf;
	42	size_t buf_size;
	43	struct vhost_memory *mem;
	44	};
	45
46f9c2b9	46	bool vq_notify(struct virtqueue *vq)
4e53f78e MT	47	{
	48	struct vq_info *info = vq->priv;
	49	unsigned long long v = 1;
	50	int r;
	51	r = write(info->kick, &v, sizeof v);
	52	assert(r == sizeof v);
46f9c2b9	53	return true;
4e53f78e MT	54	}
	55
	56	void vq_callback(struct virtqueue *vq)
	57	{
	58	}
	59
	60
	61	void vhost_vq_setup(struct vdev_info dev, struct vq_info info)
	62	{
	63	struct vhost_vring_state state = { .index = info->idx };
	64	struct vhost_vring_file file = { .index = info->idx };
e16e12be	65	unsigned long long features = dev->vdev.features;
4e53f78e MT	66	struct vhost_vring_addr addr = {
	67	.index = info->idx,
	68	.desc_user_addr = (uint64_t)(unsigned long)info->vring.desc,
	69	.avail_user_addr = (uint64_t)(unsigned long)info->vring.avail,
	70	.used_user_addr = (uint64_t)(unsigned long)info->vring.used,
	71	};
	72	int r;
	73	r = ioctl(dev->control, VHOST_SET_FEATURES, &features);
	74	assert(r >= 0);
	75	state.num = info->vring.num;
	76	r = ioctl(dev->control, VHOST_SET_VRING_NUM, &state);
	77	assert(r >= 0);
	78	state.num = 0;
	79	r = ioctl(dev->control, VHOST_SET_VRING_BASE, &state);
	80	assert(r >= 0);
	81	r = ioctl(dev->control, VHOST_SET_VRING_ADDR, &addr);
	82	assert(r >= 0);
	83	file.fd = info->kick;
	84	r = ioctl(dev->control, VHOST_SET_VRING_KICK, &file);
	85	assert(r >= 0);
	86	file.fd = info->call;
	87	r = ioctl(dev->control, VHOST_SET_VRING_CALL, &file);
	88	assert(r >= 0);
	89	}
	90
	91	static void vq_info_add(struct vdev_info *dev, int num)
	92	{
	93	struct vq_info *info = &dev->vqs[dev->nvqs];
	94	int r;
	95	info->idx = dev->nvqs;
	96	info->kick = eventfd(0, EFD_NONBLOCK);
	97	info->call = eventfd(0, EFD_NONBLOCK);
	98	r = posix_memalign(&info->ring, 4096, vring_size(num, 4096));
	99	assert(r >= 0);
	100	memset(info->ring, 0, vring_size(num, 4096));
	101	vring_init(&info->vring, num, info->ring, 4096);
73640c99 MT	102	info->vq = vring_new_virtqueue(info->idx,
73640c99 MT	103	info->vring.num, 4096, &dev->vdev,
0a12ae40	104	true, false, info->ring,
4e53f78e MT	105	vq_notify, vq_callback, "test");
	106	assert(info->vq);
	107	info->vq->priv = info;
	108	vhost_vq_setup(dev, info);
	109	dev->fds[info->idx].fd = info->call;
	110	dev->fds[info->idx].events = POLLIN;
	111	dev->nvqs++;
	112	}
	113
	114	static void vdev_info_init(struct vdev_info* dev, unsigned long long features)
	115	{
	116	int r;
	117	memset(dev, 0, sizeof *dev);
e16e12be	118	dev->vdev.features = features;
4e53f78e MT	119	dev->buf_size = 1024;
	120	dev->buf = malloc(dev->buf_size);
	121	assert(dev->buf);
	122	dev->control = open("/dev/vhost-test", O_RDWR);
	123	assert(dev->control >= 0);
	124	r = ioctl(dev->control, VHOST_SET_OWNER, NULL);
	125	assert(r >= 0);
	126	dev->mem = malloc(offsetof(struct vhost_memory, regions) +
	127	sizeof dev->mem->regions[0]);
	128	assert(dev->mem);
	129	memset(dev->mem, 0, offsetof(struct vhost_memory, regions) +
	130	sizeof dev->mem->regions[0]);
	131	dev->mem->nregions = 1;
	132	dev->mem->regions[0].guest_phys_addr = (long)dev->buf;
	133	dev->mem->regions[0].userspace_addr = (long)dev->buf;
	134	dev->mem->regions[0].memory_size = dev->buf_size;
	135	r = ioctl(dev->control, VHOST_SET_MEM_TABLE, dev->mem);
	136	assert(r >= 0);
	137	}
	138
	139	/* TODO: this is pretty bad: we get a cache line bounce
	140	* for the wait queue on poll and another one on read,
	141	* plus the read which is there just to clear the
	142	* current state. */
	143	static void wait_for_interrupt(struct vdev_info *dev)
	144	{
	145	int i;
	146	unsigned long long val;
	147	poll(dev->fds, dev->nvqs, -1);
	148	for (i = 0; i < dev->nvqs; ++i)
	149	if (dev->fds[i].revents & POLLIN) {
	150	read(dev->fds[i].fd, &val, sizeof val);
	151	}
	152	}
	153
64d09888 MT	154	static void run_test(struct vdev_info dev, struct vq_info vq,
64d09888 MT	155	bool delayed, int bufs)
4e53f78e MT	156	{
	157	struct scatterlist sl;
	158	long started = 0, completed = 0;
	159	long completed_before;
	160	int r, test = 1;
	161	unsigned len;
	162	long long spurious = 0;
	163	r = ioctl(dev->control, VHOST_TEST_RUN, &test);
	164	assert(r >= 0);
	165	for (;;) {
	166	virtqueue_disable_cb(vq->vq);
	167	completed_before = completed;
	168	do {
	169	if (started < bufs) {
	170	sg_init_one(&sl, dev->buf, dev->buf_size);
cf994e0a RR	171	r = virtqueue_add_outbuf(vq->vq, &sl, 1,
	172	dev->buf + started,
	173	GFP_ATOMIC);
de929b04	174	if (likely(r == 0)) {
4e53f78e	175	++started;
be40d5cc	176	if (unlikely(!virtqueue_kick(vq->vq)))
53c18c99	177	r = -1;
4e53f78e MT	178	}
	179	} else
	180	r = -1;
	181
	182	/* Flush out completed bufs if any */
	183	if (virtqueue_get_buf(vq->vq, &len)) {
	184	++completed;
	185	r = 0;
	186	}
	187
de929b04	188	} while (r == 0);
4e53f78e MT	189	if (completed == completed_before)
	190	++spurious;
	191	assert(completed <= bufs);
	192	assert(started <= bufs);
	193	if (completed == bufs)
	194	break;
64d09888 MT	195	if (delayed) {
	196	if (virtqueue_enable_cb_delayed(vq->vq))
	197	wait_for_interrupt(dev);
	198	} else {
	199	if (virtqueue_enable_cb(vq->vq))
	200	wait_for_interrupt(dev);
4e53f78e MT	201	}
	202	}
	203	test = 0;
	204	r = ioctl(dev->control, VHOST_TEST_RUN, &test);
	205	assert(r >= 0);
96fb20c3	206	fprintf(stderr, "spurious wakeups: 0x%llx\n", spurious);
4e53f78e MT	207	}
	208
	209	const char optstring[] = "h";
	210	const struct option longopts[] = {
	211	{
	212	.name = "help",
	213	.val = 'h',
	214	},
4423fe40 MT	215	{
	216	.name = "event-idx",
	217	.val = 'E',
	218	},
	219	{
	220	.name = "no-event-idx",
	221	.val = 'e',
	222	},
4e53f78e MT	223	{
	224	.name = "indirect",
	225	.val = 'I',
	226	},
	227	{
	228	.name = "no-indirect",
	229	.val = 'i',
	230	},
43b09122 MT	231	{
	232	.name = "virtio-1",
	233	.val = '1',
	234	},
	235	{
	236	.name = "no-virtio-1",
	237	.val = '0',
	238	},
64d09888 MT	239	{
	240	.name = "delayed-interrupt",
	241	.val = 'D',
	242	},
	243	{
	244	.name = "no-delayed-interrupt",
	245	.val = 'd',
	246	},
4e53f78e MT	247	{
	248	}
	249	};
	250
4a7d6455	251	static void help(void)
4e53f78e	252	{
4423fe40 MT	253	fprintf(stderr, "Usage: virtio_test [--help]"
	254	" [--no-indirect]"
	255	" [--no-event-idx]"
43b09122	256	" [--no-virtio-1]"
64d09888	257	" [--delayed-interrupt]"
4423fe40	258	"\n");
4e53f78e MT	259	}
	260
	261	int main(int argc, char **argv)
	262	{
	263	struct vdev_info dev;
4423fe40	264	unsigned long long features = (1ULL << VIRTIO_RING_F_INDIRECT_DESC) \|
43b09122	265	(1ULL << VIRTIO_RING_F_EVENT_IDX) \| (1ULL << VIRTIO_F_VERSION_1);
4e53f78e	266	int o;
64d09888	267	bool delayed = false;
4e53f78e MT	268
	269	for (;;) {
	270	o = getopt_long(argc, argv, optstring, longopts, NULL);
	271	switch (o) {
	272	case -1:
	273	goto done;
	274	case '?':
	275	help();
	276	exit(2);
4423fe40 MT	277	case 'e':
	278	features &= ~(1ULL << VIRTIO_RING_F_EVENT_IDX);
	279	break;
4e53f78e MT	280	case 'h':
	281	help();
	282	goto done;
	283	case 'i':
	284	features &= ~(1ULL << VIRTIO_RING_F_INDIRECT_DESC);
	285	break;
43b09122 MT	286	case '0':
	287	features &= ~(1ULL << VIRTIO_F_VERSION_1);
	288	break;
64d09888 MT	289	case 'D':
	290	delayed = true;
	291	break;
4e53f78e MT	292	default:
	293	assert(0);
	294	break;
	295	}
	296	}
	297
	298	done:
	299	vdev_info_init(&dev, features);
	300	vq_info_add(&dev, 256);
64d09888	301	run_test(&dev, &dev.vqs[0], delayed, 0x100000);
4e53f78e MT	302	return 0;
4e53f78e MT	303	}