mirror of https://gitee.com/openkylin/qemu.git
libqos: Added indirect descriptor support to virtio implementation
Add functions necessary for working with indirect descriptors. Add test using new functions. Reviewed-by: Stefan Hajnoczi <stefanha@redhat.com> Signed-off-by: Marc Marí <marc.mari.barcelo@gmail.com> Signed-off-by: Stefan Hajnoczi <stefanha@redhat.com>
This commit is contained in:
parent
bf3c63d201
commit
f294b029aa
|
@ -107,6 +107,12 @@ static void qvirtio_pci_set_features(QVirtioDevice *d, uint32_t features)
|
|||
qpci_io_writel(dev->pdev, dev->addr + QVIRTIO_GUEST_FEATURES, features);
|
||||
}
|
||||
|
||||
static uint32_t qvirtio_pci_get_guest_features(QVirtioDevice *d)
|
||||
{
|
||||
QVirtioPCIDevice *dev = (QVirtioPCIDevice *)d;
|
||||
return qpci_io_readl(dev->pdev, dev->addr + QVIRTIO_GUEST_FEATURES);
|
||||
}
|
||||
|
||||
static uint8_t qvirtio_pci_get_status(QVirtioDevice *d)
|
||||
{
|
||||
QVirtioPCIDevice *dev = (QVirtioPCIDevice *)d;
|
||||
|
@ -146,10 +152,12 @@ static void qvirtio_pci_set_queue_address(QVirtioDevice *d, uint32_t pfn)
|
|||
static QVirtQueue *qvirtio_pci_virtqueue_setup(QVirtioDevice *d,
|
||||
QGuestAllocator *alloc, uint16_t index)
|
||||
{
|
||||
uint32_t feat;
|
||||
uint64_t addr;
|
||||
QVirtQueue *vq;
|
||||
|
||||
vq = g_malloc0(sizeof(*vq));
|
||||
feat = qvirtio_pci_get_guest_features(d);
|
||||
|
||||
qvirtio_pci_queue_select(d, index);
|
||||
vq->index = index;
|
||||
|
@ -157,6 +165,7 @@ static QVirtQueue *qvirtio_pci_virtqueue_setup(QVirtioDevice *d,
|
|||
vq->free_head = 0;
|
||||
vq->num_free = vq->size;
|
||||
vq->align = QVIRTIO_PCI_ALIGN;
|
||||
vq->indirect = (feat & QVIRTIO_F_RING_INDIRECT_DESC) != 0;
|
||||
|
||||
/* Check different than 0 */
|
||||
g_assert_cmpint(vq->size, !=, 0);
|
||||
|
@ -186,6 +195,7 @@ const QVirtioBus qvirtio_pci = {
|
|||
.config_readq = qvirtio_pci_config_readq,
|
||||
.get_features = qvirtio_pci_get_features,
|
||||
.set_features = qvirtio_pci_set_features,
|
||||
.get_guest_features = qvirtio_pci_get_guest_features,
|
||||
.get_status = qvirtio_pci_get_status,
|
||||
.set_status = qvirtio_pci_set_status,
|
||||
.get_isr_status = qvirtio_pci_get_isr_status,
|
||||
|
|
|
@ -116,6 +116,51 @@ void qvring_init(const QGuestAllocator *alloc, QVirtQueue *vq, uint64_t addr)
|
|||
writew(vq->used, 0);
|
||||
}
|
||||
|
||||
QVRingIndirectDesc *qvring_indirect_desc_setup(QVirtioDevice *d,
|
||||
QGuestAllocator *alloc, uint16_t elem)
|
||||
{
|
||||
int i;
|
||||
QVRingIndirectDesc *indirect = g_malloc(sizeof(*indirect));
|
||||
|
||||
indirect->index = 0;
|
||||
indirect->elem = elem;
|
||||
indirect->desc = guest_alloc(alloc, sizeof(QVRingDesc)*elem);
|
||||
|
||||
for (i = 0; i < elem - 1; ++i) {
|
||||
/* indirect->desc[i].addr */
|
||||
writeq(indirect->desc + (16 * i), 0);
|
||||
/* indirect->desc[i].flags */
|
||||
writew(indirect->desc + (16 * i) + 12, QVRING_DESC_F_NEXT);
|
||||
/* indirect->desc[i].next */
|
||||
writew(indirect->desc + (16 * i) + 14, i + 1);
|
||||
}
|
||||
|
||||
return indirect;
|
||||
}
|
||||
|
||||
void qvring_indirect_desc_add(QVRingIndirectDesc *indirect, uint64_t data,
|
||||
uint32_t len, bool write)
|
||||
{
|
||||
uint16_t flags;
|
||||
|
||||
g_assert_cmpint(indirect->index, <, indirect->elem);
|
||||
|
||||
flags = readw(indirect->desc + (16 * indirect->index) + 12);
|
||||
|
||||
if (write) {
|
||||
flags |= QVRING_DESC_F_WRITE;
|
||||
}
|
||||
|
||||
/* indirect->desc[indirect->index].addr */
|
||||
writeq(indirect->desc + (16 * indirect->index), data);
|
||||
/* indirect->desc[indirect->index].len */
|
||||
writel(indirect->desc + (16 * indirect->index) + 8, len);
|
||||
/* indirect->desc[indirect->index].flags */
|
||||
writew(indirect->desc + (16 * indirect->index) + 12, flags);
|
||||
|
||||
indirect->index++;
|
||||
}
|
||||
|
||||
uint32_t qvirtqueue_add(QVirtQueue *vq, uint64_t data, uint32_t len, bool write,
|
||||
bool next)
|
||||
{
|
||||
|
@ -140,6 +185,25 @@ uint32_t qvirtqueue_add(QVirtQueue *vq, uint64_t data, uint32_t len, bool write,
|
|||
return vq->free_head++; /* Return and increase, in this order */
|
||||
}
|
||||
|
||||
uint32_t qvirtqueue_add_indirect(QVirtQueue *vq, QVRingIndirectDesc *indirect)
|
||||
{
|
||||
g_assert(vq->indirect);
|
||||
g_assert_cmpint(vq->size, >=, indirect->elem);
|
||||
g_assert_cmpint(indirect->index, ==, indirect->elem);
|
||||
|
||||
vq->num_free--;
|
||||
|
||||
/* vq->desc[vq->free_head].addr */
|
||||
writeq(vq->desc + (16 * vq->free_head), indirect->desc);
|
||||
/* vq->desc[vq->free_head].len */
|
||||
writel(vq->desc + (16 * vq->free_head) + 8,
|
||||
sizeof(QVRingDesc) * indirect->elem);
|
||||
/* vq->desc[vq->free_head].flags */
|
||||
writew(vq->desc + (16 * vq->free_head) + 12, QVRING_DESC_F_INDIRECT);
|
||||
|
||||
return vq->free_head++; /* Return and increase, in this order */
|
||||
}
|
||||
|
||||
void qvirtqueue_kick(const QVirtioBus *bus, QVirtioDevice *d, QVirtQueue *vq,
|
||||
uint32_t free_head)
|
||||
{
|
||||
|
|
|
@ -22,6 +22,11 @@
|
|||
#define QVIRTIO_NET_DEVICE_ID 0x1
|
||||
#define QVIRTIO_BLK_DEVICE_ID 0x2
|
||||
|
||||
#define QVIRTIO_F_NOTIFY_ON_EMPTY 0x01000000
|
||||
#define QVIRTIO_F_ANY_LAYOUT 0x08000000
|
||||
#define QVIRTIO_F_RING_INDIRECT_DESC 0x10000000
|
||||
#define QVIRTIO_F_RING_EVENT_IDX 0x20000000
|
||||
|
||||
#define QVRING_DESC_F_NEXT 0x1
|
||||
#define QVRING_DESC_F_WRITE 0x2
|
||||
#define QVRING_DESC_F_INDIRECT 0x4
|
||||
|
@ -74,8 +79,15 @@ typedef struct QVirtQueue {
|
|||
uint32_t free_head;
|
||||
uint32_t num_free;
|
||||
uint32_t align;
|
||||
bool indirect;
|
||||
} QVirtQueue;
|
||||
|
||||
typedef struct QVRingIndirectDesc {
|
||||
uint64_t desc; /* This points to an array fo QVRingDesc */
|
||||
uint16_t index;
|
||||
uint16_t elem;
|
||||
} QVRingIndirectDesc;
|
||||
|
||||
typedef struct QVirtioBus {
|
||||
uint8_t (*config_readb)(QVirtioDevice *d, void *addr);
|
||||
uint16_t (*config_readw)(QVirtioDevice *d, void *addr);
|
||||
|
@ -85,9 +97,12 @@ typedef struct QVirtioBus {
|
|||
/* Get features of the device */
|
||||
uint32_t (*get_features)(QVirtioDevice *d);
|
||||
|
||||
/* Get features of the device */
|
||||
/* Set features of the device */
|
||||
void (*set_features)(QVirtioDevice *d, uint32_t features);
|
||||
|
||||
/* Get features of the guest */
|
||||
uint32_t (*get_guest_features)(QVirtioDevice *d);
|
||||
|
||||
/* Get status of the device */
|
||||
uint8_t (*get_status)(QVirtioDevice *d);
|
||||
|
||||
|
@ -144,8 +159,13 @@ QVirtQueue *qvirtqueue_setup(const QVirtioBus *bus, QVirtioDevice *d,
|
|||
QGuestAllocator *alloc, uint16_t index);
|
||||
|
||||
void qvring_init(const QGuestAllocator *alloc, QVirtQueue *vq, uint64_t addr);
|
||||
QVRingIndirectDesc *qvring_indirect_desc_setup(QVirtioDevice *d,
|
||||
QGuestAllocator *alloc, uint16_t elem);
|
||||
void qvring_indirect_desc_add(QVRingIndirectDesc *indirect, uint64_t data,
|
||||
uint32_t len, bool write);
|
||||
uint32_t qvirtqueue_add(QVirtQueue *vq, uint64_t data, uint32_t len, bool write,
|
||||
bool next);
|
||||
uint32_t qvirtqueue_add_indirect(QVirtQueue *vq, QVRingIndirectDesc *indirect);
|
||||
void qvirtqueue_kick(const QVirtioBus *bus, QVirtioDevice *d, QVirtQueue *vq,
|
||||
uint32_t free_head);
|
||||
|
||||
|
|
|
@ -278,6 +278,105 @@ static void pci_basic(void)
|
|||
test_end();
|
||||
}
|
||||
|
||||
static void pci_indirect(void)
|
||||
{
|
||||
QVirtioPCIDevice *dev;
|
||||
QPCIBus *bus;
|
||||
QVirtQueue *vq;
|
||||
QGuestAllocator *alloc;
|
||||
QVirtioBlkReq req;
|
||||
QVRingIndirectDesc *indirect;
|
||||
void *addr;
|
||||
uint64_t req_addr;
|
||||
uint64_t capacity;
|
||||
uint32_t features;
|
||||
uint32_t free_head;
|
||||
uint8_t status;
|
||||
char *data;
|
||||
|
||||
bus = test_start();
|
||||
|
||||
dev = virtio_blk_init(bus);
|
||||
|
||||
/* MSI-X is not enabled */
|
||||
addr = dev->addr + QVIRTIO_DEVICE_SPECIFIC_NO_MSIX;
|
||||
|
||||
capacity = qvirtio_config_readq(&qvirtio_pci, &dev->vdev, addr);
|
||||
g_assert_cmpint(capacity, ==, TEST_IMAGE_SIZE / 512);
|
||||
|
||||
features = qvirtio_get_features(&qvirtio_pci, &dev->vdev);
|
||||
g_assert_cmphex(features & QVIRTIO_F_RING_INDIRECT_DESC, !=, 0);
|
||||
features = features & ~(QVIRTIO_F_BAD_FEATURE | QVIRTIO_F_RING_EVENT_IDX |
|
||||
QVIRTIO_BLK_F_SCSI);
|
||||
qvirtio_set_features(&qvirtio_pci, &dev->vdev, features);
|
||||
|
||||
alloc = pc_alloc_init();
|
||||
vq = qvirtqueue_setup(&qvirtio_pci, &dev->vdev, alloc, 0);
|
||||
|
||||
qvirtio_set_driver_ok(&qvirtio_pci, &dev->vdev);
|
||||
|
||||
/* Write request */
|
||||
req.type = QVIRTIO_BLK_T_OUT;
|
||||
req.ioprio = 1;
|
||||
req.sector = 0;
|
||||
req.data = g_malloc0(512);
|
||||
strcpy(req.data, "TEST");
|
||||
|
||||
req_addr = virtio_blk_request(alloc, &req, 512);
|
||||
|
||||
g_free(req.data);
|
||||
|
||||
indirect = qvring_indirect_desc_setup(&dev->vdev, alloc, 2);
|
||||
qvring_indirect_desc_add(indirect, req_addr, 528, false);
|
||||
qvring_indirect_desc_add(indirect, req_addr + 528, 1, true);
|
||||
free_head = qvirtqueue_add_indirect(vq, indirect);
|
||||
qvirtqueue_kick(&qvirtio_pci, &dev->vdev, vq, free_head);
|
||||
|
||||
g_assert(qvirtio_wait_isr(&qvirtio_pci, &dev->vdev, 0x1,
|
||||
QVIRTIO_BLK_TIMEOUT));
|
||||
status = readb(req_addr + 528);
|
||||
g_assert_cmpint(status, ==, 0);
|
||||
|
||||
g_free(indirect);
|
||||
guest_free(alloc, req_addr);
|
||||
|
||||
/* Read request */
|
||||
req.type = QVIRTIO_BLK_T_IN;
|
||||
req.ioprio = 1;
|
||||
req.sector = 0;
|
||||
req.data = g_malloc0(512);
|
||||
strcpy(req.data, "TEST");
|
||||
|
||||
req_addr = virtio_blk_request(alloc, &req, 512);
|
||||
|
||||
g_free(req.data);
|
||||
|
||||
indirect = qvring_indirect_desc_setup(&dev->vdev, alloc, 2);
|
||||
qvring_indirect_desc_add(indirect, req_addr, 16, false);
|
||||
qvring_indirect_desc_add(indirect, req_addr + 16, 513, true);
|
||||
free_head = qvirtqueue_add_indirect(vq, indirect);
|
||||
qvirtqueue_kick(&qvirtio_pci, &dev->vdev, vq, free_head);
|
||||
|
||||
g_assert(qvirtio_wait_isr(&qvirtio_pci, &dev->vdev, 0x1,
|
||||
QVIRTIO_BLK_TIMEOUT));
|
||||
status = readb(req_addr + 528);
|
||||
g_assert_cmpint(status, ==, 0);
|
||||
|
||||
data = g_malloc0(512);
|
||||
memread(req_addr + 16, data, 512);
|
||||
g_assert_cmpstr(data, ==, "TEST");
|
||||
g_free(data);
|
||||
|
||||
g_free(indirect);
|
||||
guest_free(alloc, req_addr);
|
||||
|
||||
/* End test */
|
||||
guest_free(alloc, vq->desc);
|
||||
qvirtio_pci_device_disable(dev);
|
||||
g_free(dev);
|
||||
test_end();
|
||||
}
|
||||
|
||||
int main(int argc, char **argv)
|
||||
{
|
||||
int ret;
|
||||
|
@ -285,6 +384,7 @@ int main(int argc, char **argv)
|
|||
g_test_init(&argc, &argv, NULL);
|
||||
|
||||
g_test_add_func("/virtio/blk/pci/basic", pci_basic);
|
||||
g_test_add_func("/virtio/blk/pci/indirect", pci_indirect);
|
||||
|
||||
ret = g_test_run();
|
||||
|
||||
|
|
Loading…
Reference in New Issue