[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 <glib.h>
#include <string.h>
#include "libqtest.h"
#include "qemu/osdep.h"
#include <stdio.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"

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

#define MAX_NUM_QUEUES 64

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

typedef struct {
    uint8_t lun[8];
    int64_t tag;
    uint8_t task_attr;
    uint8_t prio;
    uint8_t crn;
    uint8_t cdb[CDB_SIZE];
} QEMU_PACKED QVirtIOSCSICmdReq;

typedef struct {
    uint32_t sense_len;
    uint32_t resid;
    uint16_t status_qualifier;
    uint8_t status;
    uint8_t response;
    uint8_t sense[96];
} QEMU_PACKED QVirtIOSCSICmdResp;

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++) {
        guest_free(vs->alloc, vs->vq[i]->desc);
    }
    pc_alloc_uninit(vs->alloc);
    qvirtio_pci_device_disable(container_of(vs->dev, QVirtioPCIDevice, vdev));
    g_free(vs->dev);
    qpci_free_pc(vs->bus);
}

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,
                                      QVirtIOSCSICmdResp *resp_out)
{
    QVirtQueue *vq;
    QVirtIOSCSICmdReq req = { { 0 } };
    QVirtIOSCSICmdResp 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, 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(&qvirtio_pci, vs->dev, vq, free_head);
    qvirtio_wait_queue_isr(&qvirtio_pci, vs->dev, vq, QVIRTIO_SCSI_TIMEOUT_US);

    response = readb(resp_addr + offsetof(QVirtIOSCSICmdResp, 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[CDB_SIZE] = {};
    QVirtIOSCSI *vs;
    QVirtioPCIDevice *dev;
    QVirtIOSCSICmdResp resp;
    void *addr;
    int i;

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

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

    qvirtio_pci_device_enable(dev);
    qvirtio_reset(&qvirtio_pci, vs->dev);
    qvirtio_set_acknowledge(&qvirtio_pci, vs->dev);
    qvirtio_set_driver(&qvirtio_pci, vs->dev);

    addr = dev->addr + QVIRTIO_PCI_DEVICE_SPECIFIC_NO_MSIX;
    vs->num_queues = qvirtio_config_readl(&qvirtio_pci, 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(&qvirtio_pci, 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[CDB_SIZE] = { 0x41, 0x00, 0x00, 0x00, 0x00,
                                               0x01, 0x00, 0x00, 0x02, 0x00 };
    const uint8_t write_same_cdb_2[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)
{
    int ret;

    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);

    ret = g_test_run();

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