[mirror_qemu.git] / tests / virtio-scsi-test.c

/*
 * QTest testcase for VirtIO SCSI
 *
 * Copyright (c) 2014 SUSE LINUX Products GmbH
 * Copyright (c) 2015 Red Hat Inc.
 *
 * This work is licensed under the terms of the GNU GPL, version 2 or later.
 * See the COPYING file in the top-level directory.
 */

#include "qemu/osdep.h"
#include "libqtest.h"
#include "block/scsi.h"
#include "libqos/virtio.h"
#include "libqos/virtio-pci.h"
#include "libqos/pci-pc.h"
#include "libqos/malloc.h"
#include "libqos/malloc-pc.h"
#include "libqos/malloc-generic.h"
#include "standard-headers/linux/virtio_ids.h"
#include "standard-headers/linux/virtio_pci.h"
#include "standard-headers/linux/virtio_scsi.h"

#define PCI_SLOT                0x02
#define PCI_FN                  0x00
#define QVIRTIO_SCSI_TIMEOUT_US (1 * 1000 * 1000)

#define MAX_NUM_QUEUES 64

typedef struct {
    QVirtioDevice *dev;
    QGuestAllocator *alloc;
    QPCIBus *bus;
    int num_queues;
    QVirtQueue *vq[MAX_NUM_QUEUES + 2];
} QVirtIOSCSI;

static void qvirtio_scsi_start(const char *extra_opts)
{
    char *cmdline;

    cmdline = g_strdup_printf(
                "-drive id=drv0,if=none,file=/dev/null,format=raw "
                "-device virtio-scsi-pci,id=vs0 "
                "-device scsi-hd,bus=vs0.0,drive=drv0 %s",
                extra_opts ? : "");
    qtest_start(cmdline);
    g_free(cmdline);
}

static void qvirtio_scsi_stop(void)
{
    qtest_end();
}

static void qvirtio_scsi_pci_free(QVirtIOSCSI *vs)
{
    int i;

    for (i = 0; i < vs->num_queues + 2; i++) {
        qvirtqueue_cleanup(vs->dev->bus, vs->vq[i], vs->alloc);
    }
    pc_alloc_uninit(vs->alloc);
    qvirtio_pci_device_disable(container_of(vs->dev, QVirtioPCIDevice, vdev));
    g_free(vs->dev);
    qpci_free_pc(vs->bus);
    g_free(vs);
}

static uint64_t qvirtio_scsi_alloc(QVirtIOSCSI *vs, size_t alloc_size,
                                   const void *data)
{
    uint64_t addr;

    addr = guest_alloc(vs->alloc, alloc_size);
    if (data) {
        memwrite(addr, data, alloc_size);
    }

    return addr;
}

static uint8_t virtio_scsi_do_command(QVirtIOSCSI *vs, const uint8_t *cdb,
                                      const uint8_t *data_in,
                                      size_t data_in_len,
                                      uint8_t *data_out, size_t data_out_len,
                                      struct virtio_scsi_cmd_resp *resp_out)
{
    QVirtQueue *vq;
    struct virtio_scsi_cmd_req req = { { 0 } };
    struct virtio_scsi_cmd_resp resp = { .response = 0xff, .status = 0xff };
    uint64_t req_addr, resp_addr, data_in_addr = 0, data_out_addr = 0;
    uint8_t response;
    uint32_t free_head;

    vq = vs->vq[2];

    req.lun[0] = 1; /* Select LUN */
    req.lun[1] = 1; /* Select target 1 */
    memcpy(req.cdb, cdb, VIRTIO_SCSI_CDB_SIZE);

    /* XXX: Fix endian if any multi-byte field in req/resp is used */

    /* Add request header */
    req_addr = qvirtio_scsi_alloc(vs, sizeof(req), &req);
    free_head = qvirtqueue_add(vq, req_addr, sizeof(req), false, true);

    if (data_out_len) {
        data_out_addr = qvirtio_scsi_alloc(vs, data_out_len, data_out);
        qvirtqueue_add(vq, data_out_addr, data_out_len, false, true);
    }

    /* Add response header */
    resp_addr = qvirtio_scsi_alloc(vs, sizeof(resp), &resp);
    qvirtqueue_add(vq, resp_addr, sizeof(resp), true, !!data_in_len);

    if (data_in_len) {
        data_in_addr = qvirtio_scsi_alloc(vs, data_in_len, data_in);
        qvirtqueue_add(vq, data_in_addr, data_in_len, true, false);
    }

    qvirtqueue_kick(vs->dev, vq, free_head);
    qvirtio_wait_queue_isr(vs->dev, vq, QVIRTIO_SCSI_TIMEOUT_US);

    response = readb(resp_addr +
                     offsetof(struct virtio_scsi_cmd_resp, response));

    if (resp_out) {
        memread(resp_addr, resp_out, sizeof(*resp_out));
    }

    guest_free(vs->alloc, req_addr);
    guest_free(vs->alloc, resp_addr);
    guest_free(vs->alloc, data_in_addr);
    guest_free(vs->alloc, data_out_addr);
    return response;
}

static QVirtIOSCSI *qvirtio_scsi_pci_init(int slot)
{
    const uint8_t test_unit_ready_cdb[VIRTIO_SCSI_CDB_SIZE] = {};
    QVirtIOSCSI *vs;
    QVirtioPCIDevice *dev;
    struct virtio_scsi_cmd_resp resp;
    void *addr;
    int i;

    vs = g_new0(QVirtIOSCSI, 1);
    vs->alloc = pc_alloc_init();
    vs->bus = qpci_init_pc(NULL);

    dev = qvirtio_pci_device_find(vs->bus, VIRTIO_ID_SCSI);
    vs->dev = (QVirtioDevice *)dev;
    g_assert(dev != NULL);
    g_assert_cmphex(vs->dev->device_type, ==, VIRTIO_ID_SCSI);

    qvirtio_pci_device_enable(dev);
    qvirtio_reset(vs->dev);
    qvirtio_set_acknowledge(vs->dev);
    qvirtio_set_driver(vs->dev);

    addr = dev->addr + VIRTIO_PCI_CONFIG_OFF(false);
    vs->num_queues = qvirtio_config_readl(vs->dev, (uint64_t)(uintptr_t)addr);

    g_assert_cmpint(vs->num_queues, <, MAX_NUM_QUEUES);

    for (i = 0; i < vs->num_queues + 2; i++) {
        vs->vq[i] = qvirtqueue_setup(vs->dev, vs->alloc, i);
    }

    /* Clear the POWER ON OCCURRED unit attention */
    g_assert_cmpint(virtio_scsi_do_command(vs, test_unit_ready_cdb,
                                           NULL, 0, NULL, 0, &resp),
                    ==, 0);
    g_assert_cmpint(resp.status, ==, CHECK_CONDITION);
    g_assert_cmpint(resp.sense[0], ==, 0x70); /* Fixed format sense buffer */
    g_assert_cmpint(resp.sense[2], ==, UNIT_ATTENTION);
    g_assert_cmpint(resp.sense[12], ==, 0x29); /* POWER ON */
    g_assert_cmpint(resp.sense[13], ==, 0x00);

    return vs;
}

/* Tests only initialization so far. TODO: Replace with functional tests */
static void pci_nop(void)
{
    qvirtio_scsi_start(NULL);
    qvirtio_scsi_stop();
}

static void hotplug(void)
{
    QDict *response;

    qvirtio_scsi_start("-drive id=drv1,if=none,file=/dev/null,format=raw");
    response = qmp("{\"execute\": \"device_add\","
                   " \"arguments\": {"
                   "   \"driver\": \"scsi-hd\","
                   "   \"id\": \"scsi-hd\","
                   "   \"drive\": \"drv1\""
                   "}}");

    g_assert(response);
    g_assert(!qdict_haskey(response, "error"));
    QDECREF(response);

    response = qmp("{\"execute\": \"device_del\","
                   " \"arguments\": {"
                   "   \"id\": \"scsi-hd\""
                   "}}");

    g_assert(response);
    g_assert(!qdict_haskey(response, "error"));
    g_assert(qdict_haskey(response, "event"));
    g_assert(!strcmp(qdict_get_str(response, "event"), "DEVICE_DELETED"));
    QDECREF(response);
    qvirtio_scsi_stop();
}

/* Test WRITE SAME with the lba not aligned */
static void test_unaligned_write_same(void)
{
    QVirtIOSCSI *vs;
    uint8_t buf1[512] = { 0 };
    uint8_t buf2[512] = { 1 };
    const uint8_t write_same_cdb_1[VIRTIO_SCSI_CDB_SIZE] = {
        0x41, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x02, 0x00
    };
    const uint8_t write_same_cdb_2[VIRTIO_SCSI_CDB_SIZE] = {
        0x41, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x33, 0x00, 0x00
    };

    qvirtio_scsi_start("-drive file=blkdebug::null-co://,if=none,id=dr1"
                       ",format=raw,file.align=4k "
                       "-device scsi-disk,drive=dr1,lun=0,scsi-id=1");
    vs = qvirtio_scsi_pci_init(PCI_SLOT);

    g_assert_cmphex(0, ==,
        virtio_scsi_do_command(vs, write_same_cdb_1, NULL, 0, buf1, 512, NULL));

    g_assert_cmphex(0, ==,
        virtio_scsi_do_command(vs, write_same_cdb_2, NULL, 0, buf2, 512, NULL));

    qvirtio_scsi_pci_free(vs);
    qvirtio_scsi_stop();
}

int main(int argc, char **argv)
{
    g_test_init(&argc, &argv, NULL);
    qtest_add_func("/virtio/scsi/pci/nop", pci_nop);
    qtest_add_func("/virtio/scsi/pci/hotplug", hotplug);
    qtest_add_func("/virtio/scsi/pci/scsi-disk/unaligned-write-same",
                   test_unaligned_write_same);

    return g_test_run();
}
Commit	Line	Data
26c9a015 AF	1	/*
	2	* QTest testcase for VirtIO SCSI
	3	*
	4	* Copyright (c) 2014 SUSE LINUX Products GmbH
397c767b	5	* Copyright (c) 2015 Red Hat Inc.
26c9a015 AF	6	*
	7	* This work is licensed under the terms of the GNU GPL, version 2 or later.
	8	* See the COPYING file in the top-level directory.
	9	*/
	10
681c28a3	11	#include "qemu/osdep.h"
26c9a015	12	#include "libqtest.h"
4bb7b0da	13	#include "block/scsi.h"
397c767b FZ	14	#include "libqos/virtio.h"
	15	#include "libqos/virtio-pci.h"
	16	#include "libqos/pci-pc.h"
	17	#include "libqos/malloc.h"
	18	#include "libqos/malloc-pc.h"
	19	#include "libqos/malloc-generic.h"
8ac9e205	20	#include "standard-headers/linux/virtio_ids.h"
c75f4c06	21	#include "standard-headers/linux/virtio_pci.h"
74f079a7	22	#include "standard-headers/linux/virtio_scsi.h"
397c767b FZ	23
	24	#define PCI_SLOT 0x02
	25	#define PCI_FN 0x00
	26	#define QVIRTIO_SCSI_TIMEOUT_US (1 * 1000 * 1000)
397c767b FZ	27
	28	#define MAX_NUM_QUEUES 64
	29
	30	typedef struct {
	31	QVirtioDevice *dev;
	32	QGuestAllocator *alloc;
	33	QPCIBus *bus;
	34	int num_queues;
	35	QVirtQueue *vq[MAX_NUM_QUEUES + 2];
	36	} QVirtIOSCSI;
	37
06b008d9 FZ	38	static void qvirtio_scsi_start(const char *extra_opts)
	39	{
	40	char *cmdline;
	41
	42	cmdline = g_strdup_printf(
	43	"-drive id=drv0,if=none,file=/dev/null,format=raw "
	44	"-device virtio-scsi-pci,id=vs0 "
	45	"-device scsi-hd,bus=vs0.0,drive=drv0 %s",
	46	extra_opts ? : "");
	47	qtest_start(cmdline);
	48	g_free(cmdline);
	49	}
	50
	51	static void qvirtio_scsi_stop(void)
	52	{
	53	qtest_end();
	54	}
	55
397c767b FZ	56	static void qvirtio_scsi_pci_free(QVirtIOSCSI *vs)
	57	{
	58	int i;
	59
	60	for (i = 0; i < vs->num_queues + 2; i++) {
6b9cdf4c	61	qvirtqueue_cleanup(vs->dev->bus, vs->vq[i], vs->alloc);
397c767b FZ	62	}
	63	pc_alloc_uninit(vs->alloc);
	64	qvirtio_pci_device_disable(container_of(vs->dev, QVirtioPCIDevice, vdev));
	65	g_free(vs->dev);
	66	qpci_free_pc(vs->bus);
f62e0bbb	67	g_free(vs);
397c767b FZ	68	}
	69
	70	static uint64_t qvirtio_scsi_alloc(QVirtIOSCSI *vs, size_t alloc_size,
	71	const void *data)
	72	{
	73	uint64_t addr;
	74
	75	addr = guest_alloc(vs->alloc, alloc_size);
	76	if (data) {
	77	memwrite(addr, data, alloc_size);
	78	}
	79
	80	return addr;
	81	}
	82
	83	static uint8_t virtio_scsi_do_command(QVirtIOSCSI vs, const uint8_t cdb,
	84	const uint8_t *data_in,
	85	size_t data_in_len,
4bb7b0da	86	uint8_t *data_out, size_t data_out_len,
74f079a7	87	struct virtio_scsi_cmd_resp *resp_out)
397c767b FZ	88	{
397c767b FZ	89	QVirtQueue *vq;
74f079a7 SH	90	struct virtio_scsi_cmd_req req = { { 0 } };
74f079a7 SH	91	struct virtio_scsi_cmd_resp resp = { .response = 0xff, .status = 0xff };
397c767b FZ	92	uint64_t req_addr, resp_addr, data_in_addr = 0, data_out_addr = 0;
	93	uint8_t response;
	94	uint32_t free_head;
	95
	96	vq = vs->vq[2];
	97
	98	req.lun[0] = 1; /* Select LUN */
	99	req.lun[1] = 1; /* Select target 1 */
74f079a7	100	memcpy(req.cdb, cdb, VIRTIO_SCSI_CDB_SIZE);
397c767b FZ	101
	102	/* XXX: Fix endian if any multi-byte field in req/resp is used */
	103
	104	/* Add request header */
	105	req_addr = qvirtio_scsi_alloc(vs, sizeof(req), &req);
	106	free_head = qvirtqueue_add(vq, req_addr, sizeof(req), false, true);
	107
	108	if (data_out_len) {
	109	data_out_addr = qvirtio_scsi_alloc(vs, data_out_len, data_out);
	110	qvirtqueue_add(vq, data_out_addr, data_out_len, false, true);
	111	}
	112
	113	/* Add response header */
	114	resp_addr = qvirtio_scsi_alloc(vs, sizeof(resp), &resp);
	115	qvirtqueue_add(vq, resp_addr, sizeof(resp), true, !!data_in_len);
	116
	117	if (data_in_len) {
	118	data_in_addr = qvirtio_scsi_alloc(vs, data_in_len, data_in);
	119	qvirtqueue_add(vq, data_in_addr, data_in_len, true, false);
	120	}
	121
6b9cdf4c LV	122	qvirtqueue_kick(vs->dev, vq, free_head);
6b9cdf4c LV	123	qvirtio_wait_queue_isr(vs->dev, vq, QVIRTIO_SCSI_TIMEOUT_US);
397c767b	124
74f079a7 SH	125	response = readb(resp_addr +
74f079a7 SH	126	offsetof(struct virtio_scsi_cmd_resp, response));
397c767b	127
4bb7b0da SH	128	if (resp_out) {
	129	memread(resp_addr, resp_out, sizeof(*resp_out));
	130	}
	131
397c767b FZ	132	guest_free(vs->alloc, req_addr);
	133	guest_free(vs->alloc, resp_addr);
	134	guest_free(vs->alloc, data_in_addr);
	135	guest_free(vs->alloc, data_out_addr);
	136	return response;
	137	}
	138
4bb7b0da SH	139	static QVirtIOSCSI *qvirtio_scsi_pci_init(int slot)
4bb7b0da SH	140	{
74f079a7	141	const uint8_t test_unit_ready_cdb[VIRTIO_SCSI_CDB_SIZE] = {};
4bb7b0da SH	142	QVirtIOSCSI *vs;
4bb7b0da SH	143	QVirtioPCIDevice *dev;
74f079a7	144	struct virtio_scsi_cmd_resp resp;
4bb7b0da SH	145	void *addr;
	146	int i;
	147
	148	vs = g_new0(QVirtIOSCSI, 1);
	149	vs->alloc = pc_alloc_init();
2ecd7e2f	150	vs->bus = qpci_init_pc(NULL);
4bb7b0da	151
8ac9e205	152	dev = qvirtio_pci_device_find(vs->bus, VIRTIO_ID_SCSI);
4bb7b0da SH	153	vs->dev = (QVirtioDevice *)dev;
4bb7b0da SH	154	g_assert(dev != NULL);
8ac9e205	155	g_assert_cmphex(vs->dev->device_type, ==, VIRTIO_ID_SCSI);
4bb7b0da SH	156
4bb7b0da SH	157	qvirtio_pci_device_enable(dev);
6b9cdf4c LV	158	qvirtio_reset(vs->dev);
	159	qvirtio_set_acknowledge(vs->dev);
	160	qvirtio_set_driver(vs->dev);
4bb7b0da	161
c75f4c06	162	addr = dev->addr + VIRTIO_PCI_CONFIG_OFF(false);
6b9cdf4c	163	vs->num_queues = qvirtio_config_readl(vs->dev, (uint64_t)(uintptr_t)addr);
4bb7b0da SH	164
	165	g_assert_cmpint(vs->num_queues, <, MAX_NUM_QUEUES);
	166
	167	for (i = 0; i < vs->num_queues + 2; i++) {
6b9cdf4c	168	vs->vq[i] = qvirtqueue_setup(vs->dev, vs->alloc, i);
4bb7b0da SH	169	}
	170
	171	/* Clear the POWER ON OCCURRED unit attention */
	172	g_assert_cmpint(virtio_scsi_do_command(vs, test_unit_ready_cdb,
	173	NULL, 0, NULL, 0, &resp),
	174	==, 0);
	175	g_assert_cmpint(resp.status, ==, CHECK_CONDITION);
	176	g_assert_cmpint(resp.sense[0], ==, 0x70); /* Fixed format sense buffer */
	177	g_assert_cmpint(resp.sense[2], ==, UNIT_ATTENTION);
	178	g_assert_cmpint(resp.sense[12], ==, 0x29); /* POWER ON */
	179	g_assert_cmpint(resp.sense[13], ==, 0x00);
	180
	181	return vs;
	182	}
	183
26c9a015 AF	184	/* Tests only initialization so far. TODO: Replace with functional tests */
	185	static void pci_nop(void)
	186	{
06b008d9 FZ	187	qvirtio_scsi_start(NULL);
06b008d9 FZ	188	qvirtio_scsi_stop();
26c9a015 AF	189	}
26c9a015 AF	190
ac2c4946 IM	191	static void hotplug(void)
	192	{
	193	QDict *response;
	194
06b008d9	195	qvirtio_scsi_start("-drive id=drv1,if=none,file=/dev/null,format=raw");
ac2c4946 IM	196	response = qmp("{\"execute\": \"device_add\","
	197	" \"arguments\": {"
	198	" \"driver\": \"scsi-hd\","
	199	" \"id\": \"scsi-hd\","
	200	" \"drive\": \"drv1\""
	201	"}}");
	202
	203	g_assert(response);
	204	g_assert(!qdict_haskey(response, "error"));
	205	QDECREF(response);
	206
	207	response = qmp("{\"execute\": \"device_del\","
	208	" \"arguments\": {"
	209	" \"id\": \"scsi-hd\""
	210	"}}");
	211
	212	g_assert(response);
	213	g_assert(!qdict_haskey(response, "error"));
	214	g_assert(qdict_haskey(response, "event"));
	215	g_assert(!strcmp(qdict_get_str(response, "event"), "DEVICE_DELETED"));
	216	QDECREF(response);
06b008d9	217	qvirtio_scsi_stop();
ac2c4946 IM	218	}
ac2c4946 IM	219
397c767b FZ	220	/* Test WRITE SAME with the lba not aligned */
	221	static void test_unaligned_write_same(void)
	222	{
	223	QVirtIOSCSI *vs;
975b6655 FZ	224	uint8_t buf1[512] = { 0 };
975b6655 FZ	225	uint8_t buf2[512] = { 1 };
74f079a7 SH	226	const uint8_t write_same_cdb_1[VIRTIO_SCSI_CDB_SIZE] = {
	227	0x41, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x02, 0x00
	228	};
	229	const uint8_t write_same_cdb_2[VIRTIO_SCSI_CDB_SIZE] = {
	230	0x41, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x33, 0x00, 0x00
	231	};
397c767b FZ	232
	233	qvirtio_scsi_start("-drive file=blkdebug::null-co://,if=none,id=dr1"
	234	",format=raw,file.align=4k "
	235	"-device scsi-disk,drive=dr1,lun=0,scsi-id=1");
	236	vs = qvirtio_scsi_pci_init(PCI_SLOT);
	237
	238	g_assert_cmphex(0, ==,
975b6655 FZ	239	virtio_scsi_do_command(vs, write_same_cdb_1, NULL, 0, buf1, 512, NULL));
	240
	241	g_assert_cmphex(0, ==,
	242	virtio_scsi_do_command(vs, write_same_cdb_2, NULL, 0, buf2, 512, NULL));
397c767b FZ	243
	244	qvirtio_scsi_pci_free(vs);
	245	qvirtio_scsi_stop();
	246	}
	247
26c9a015 AF	248	int main(int argc, char **argv)
26c9a015 AF	249	{
26c9a015 AF	250	g_test_init(&argc, &argv, NULL);
26c9a015 AF	251	qtest_add_func("/virtio/scsi/pci/nop", pci_nop);
ac2c4946	252	qtest_add_func("/virtio/scsi/pci/hotplug", hotplug);
397c767b FZ	253	qtest_add_func("/virtio/scsi/pci/scsi-disk/unaligned-write-same",
397c767b FZ	254	test_unaligned_write_same);
26c9a015	255
9be38598	256	return g_test_run();
26c9a015	257	}