]>
Commit | Line | Data |
---|---|---|
0a6ed700 MM |
1 | /* |
2 | * libqos virtio MMIO driver | |
3 | * | |
4 | * Copyright (c) 2014 Marc Marí | |
5 | * | |
6 | * This work is licensed under the terms of the GNU GPL, version 2 or later. | |
7 | * See the COPYING file in the top-level directory. | |
8 | */ | |
9 | ||
681c28a3 | 10 | #include "qemu/osdep.h" |
0a6ed700 | 11 | #include "libqtest.h" |
0b8fa32f | 12 | #include "qemu/module.h" |
0a6ed700 MM |
13 | #include "libqos/virtio.h" |
14 | #include "libqos/virtio-mmio.h" | |
15 | #include "libqos/malloc.h" | |
57ed038a | 16 | #include "libqos/qgraph.h" |
ee3b850a | 17 | #include "standard-headers/linux/virtio_ring.h" |
0a6ed700 | 18 | |
246fc0fb | 19 | static uint8_t qvirtio_mmio_config_readb(QVirtioDevice *d, uint64_t off) |
0a6ed700 | 20 | { |
57ed038a EGE |
21 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
22 | return qtest_readb(dev->qts, dev->addr + QVIRTIO_MMIO_DEVICE_SPECIFIC + off); | |
0a6ed700 MM |
23 | } |
24 | ||
246fc0fb | 25 | static uint16_t qvirtio_mmio_config_readw(QVirtioDevice *d, uint64_t off) |
0a6ed700 | 26 | { |
57ed038a EGE |
27 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
28 | return qtest_readw(dev->qts, dev->addr + QVIRTIO_MMIO_DEVICE_SPECIFIC + off); | |
0a6ed700 MM |
29 | } |
30 | ||
246fc0fb | 31 | static uint32_t qvirtio_mmio_config_readl(QVirtioDevice *d, uint64_t off) |
0a6ed700 | 32 | { |
57ed038a EGE |
33 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
34 | return qtest_readl(dev->qts, dev->addr + QVIRTIO_MMIO_DEVICE_SPECIFIC + off); | |
0a6ed700 MM |
35 | } |
36 | ||
246fc0fb | 37 | static uint64_t qvirtio_mmio_config_readq(QVirtioDevice *d, uint64_t off) |
0a6ed700 | 38 | { |
57ed038a EGE |
39 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
40 | return qtest_readq(dev->qts, dev->addr + QVIRTIO_MMIO_DEVICE_SPECIFIC + off); | |
0a6ed700 MM |
41 | } |
42 | ||
43 | static uint32_t qvirtio_mmio_get_features(QVirtioDevice *d) | |
44 | { | |
57ed038a EGE |
45 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
46 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_HOST_FEATURES_SEL, 0); | |
47 | return qtest_readl(dev->qts, dev->addr + QVIRTIO_MMIO_HOST_FEATURES); | |
0a6ed700 MM |
48 | } |
49 | ||
50 | static void qvirtio_mmio_set_features(QVirtioDevice *d, uint32_t features) | |
51 | { | |
57ed038a | 52 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
0a6ed700 | 53 | dev->features = features; |
57ed038a EGE |
54 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_GUEST_FEATURES_SEL, 0); |
55 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_GUEST_FEATURES, features); | |
0a6ed700 MM |
56 | } |
57 | ||
58 | static uint32_t qvirtio_mmio_get_guest_features(QVirtioDevice *d) | |
59 | { | |
57ed038a | 60 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
0a6ed700 MM |
61 | return dev->features; |
62 | } | |
63 | ||
64 | static uint8_t qvirtio_mmio_get_status(QVirtioDevice *d) | |
65 | { | |
57ed038a EGE |
66 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
67 | return (uint8_t)qtest_readl(dev->qts, dev->addr + QVIRTIO_MMIO_DEVICE_STATUS); | |
0a6ed700 MM |
68 | } |
69 | ||
70 | static void qvirtio_mmio_set_status(QVirtioDevice *d, uint8_t status) | |
71 | { | |
57ed038a EGE |
72 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
73 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_DEVICE_STATUS, (uint32_t)status); | |
0a6ed700 MM |
74 | } |
75 | ||
76 | static bool qvirtio_mmio_get_queue_isr_status(QVirtioDevice *d, QVirtQueue *vq) | |
77 | { | |
57ed038a | 78 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
0a6ed700 MM |
79 | uint32_t isr; |
80 | ||
57ed038a | 81 | isr = qtest_readl(dev->qts, dev->addr + QVIRTIO_MMIO_INTERRUPT_STATUS) & 1; |
0a6ed700 | 82 | if (isr != 0) { |
57ed038a | 83 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_INTERRUPT_ACK, 1); |
0a6ed700 MM |
84 | return true; |
85 | } | |
86 | ||
87 | return false; | |
88 | } | |
89 | ||
90 | static bool qvirtio_mmio_get_config_isr_status(QVirtioDevice *d) | |
91 | { | |
57ed038a | 92 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
0a6ed700 MM |
93 | uint32_t isr; |
94 | ||
57ed038a | 95 | isr = qtest_readl(dev->qts, dev->addr + QVIRTIO_MMIO_INTERRUPT_STATUS) & 2; |
0a6ed700 | 96 | if (isr != 0) { |
57ed038a | 97 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_INTERRUPT_ACK, 2); |
0a6ed700 MM |
98 | return true; |
99 | } | |
100 | ||
101 | return false; | |
102 | } | |
103 | ||
104 | static void qvirtio_mmio_queue_select(QVirtioDevice *d, uint16_t index) | |
105 | { | |
57ed038a EGE |
106 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
107 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_QUEUE_SEL, (uint32_t)index); | |
0a6ed700 | 108 | |
57ed038a | 109 | g_assert_cmphex(qtest_readl(dev->qts, dev->addr + QVIRTIO_MMIO_QUEUE_PFN), ==, 0); |
0a6ed700 MM |
110 | } |
111 | ||
112 | static uint16_t qvirtio_mmio_get_queue_size(QVirtioDevice *d) | |
113 | { | |
57ed038a EGE |
114 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
115 | return (uint16_t)qtest_readl(dev->qts, dev->addr + QVIRTIO_MMIO_QUEUE_NUM_MAX); | |
0a6ed700 MM |
116 | } |
117 | ||
118 | static void qvirtio_mmio_set_queue_address(QVirtioDevice *d, uint32_t pfn) | |
119 | { | |
57ed038a EGE |
120 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
121 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_QUEUE_PFN, pfn); | |
0a6ed700 MM |
122 | } |
123 | ||
124 | static QVirtQueue *qvirtio_mmio_virtqueue_setup(QVirtioDevice *d, | |
125 | QGuestAllocator *alloc, uint16_t index) | |
126 | { | |
57ed038a | 127 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
0a6ed700 MM |
128 | QVirtQueue *vq; |
129 | uint64_t addr; | |
130 | ||
131 | vq = g_malloc0(sizeof(*vq)); | |
132 | qvirtio_mmio_queue_select(d, index); | |
57ed038a | 133 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_QUEUE_ALIGN, dev->page_size); |
0a6ed700 MM |
134 | |
135 | vq->index = index; | |
136 | vq->size = qvirtio_mmio_get_queue_size(d); | |
137 | vq->free_head = 0; | |
138 | vq->num_free = vq->size; | |
139 | vq->align = dev->page_size; | |
ee3b850a SH |
140 | vq->indirect = (dev->features & (1u << VIRTIO_RING_F_INDIRECT_DESC)) != 0; |
141 | vq->event = (dev->features & (1u << VIRTIO_RING_F_EVENT_IDX)) != 0; | |
0a6ed700 | 142 | |
57ed038a | 143 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_QUEUE_NUM, vq->size); |
0a6ed700 MM |
144 | |
145 | /* Check different than 0 */ | |
146 | g_assert_cmpint(vq->size, !=, 0); | |
147 | ||
148 | /* Check power of 2 */ | |
149 | g_assert_cmpint(vq->size & (vq->size - 1), ==, 0); | |
150 | ||
151 | addr = guest_alloc(alloc, qvring_size(vq->size, dev->page_size)); | |
8b898f59 | 152 | qvring_init(dev->qts, alloc, vq, addr); |
0a6ed700 MM |
153 | qvirtio_mmio_set_queue_address(d, vq->desc / dev->page_size); |
154 | ||
155 | return vq; | |
156 | } | |
157 | ||
f1d3b991 SH |
158 | static void qvirtio_mmio_virtqueue_cleanup(QVirtQueue *vq, |
159 | QGuestAllocator *alloc) | |
160 | { | |
161 | guest_free(alloc, vq->desc); | |
162 | g_free(vq); | |
163 | } | |
164 | ||
0a6ed700 MM |
165 | static void qvirtio_mmio_virtqueue_kick(QVirtioDevice *d, QVirtQueue *vq) |
166 | { | |
57ed038a EGE |
167 | QVirtioMMIODevice *dev = container_of(d, QVirtioMMIODevice, vdev); |
168 | qtest_writel(dev->qts, dev->addr + QVIRTIO_MMIO_QUEUE_NOTIFY, vq->index); | |
0a6ed700 MM |
169 | } |
170 | ||
171 | const QVirtioBus qvirtio_mmio = { | |
172 | .config_readb = qvirtio_mmio_config_readb, | |
173 | .config_readw = qvirtio_mmio_config_readw, | |
174 | .config_readl = qvirtio_mmio_config_readl, | |
175 | .config_readq = qvirtio_mmio_config_readq, | |
176 | .get_features = qvirtio_mmio_get_features, | |
177 | .set_features = qvirtio_mmio_set_features, | |
178 | .get_guest_features = qvirtio_mmio_get_guest_features, | |
179 | .get_status = qvirtio_mmio_get_status, | |
180 | .set_status = qvirtio_mmio_set_status, | |
181 | .get_queue_isr_status = qvirtio_mmio_get_queue_isr_status, | |
182 | .get_config_isr_status = qvirtio_mmio_get_config_isr_status, | |
183 | .queue_select = qvirtio_mmio_queue_select, | |
184 | .get_queue_size = qvirtio_mmio_get_queue_size, | |
185 | .set_queue_address = qvirtio_mmio_set_queue_address, | |
186 | .virtqueue_setup = qvirtio_mmio_virtqueue_setup, | |
f1d3b991 | 187 | .virtqueue_cleanup = qvirtio_mmio_virtqueue_cleanup, |
0a6ed700 MM |
188 | .virtqueue_kick = qvirtio_mmio_virtqueue_kick, |
189 | }; | |
190 | ||
57ed038a | 191 | static void *qvirtio_mmio_get_driver(void *obj, const char *interface) |
0a6ed700 | 192 | { |
57ed038a EGE |
193 | QVirtioMMIODevice *virtio_mmio = obj; |
194 | if (!g_strcmp0(interface, "virtio-bus")) { | |
195 | return &virtio_mmio->vdev; | |
196 | } | |
197 | fprintf(stderr, "%s not present in virtio-mmio\n", interface); | |
198 | g_assert_not_reached(); | |
199 | } | |
200 | ||
201 | static void qvirtio_mmio_start_hw(QOSGraphObject *obj) | |
202 | { | |
203 | QVirtioMMIODevice *dev = (QVirtioMMIODevice *) obj; | |
204 | qvirtio_start_device(&dev->vdev); | |
205 | } | |
0a6ed700 | 206 | |
57ed038a EGE |
207 | void qvirtio_mmio_init_device(QVirtioMMIODevice *dev, QTestState *qts, |
208 | uint64_t addr, uint32_t page_size) | |
209 | { | |
210 | uint32_t magic; | |
211 | magic = qtest_readl(qts, addr + QVIRTIO_MMIO_MAGIC_VALUE); | |
0a6ed700 MM |
212 | g_assert(magic == ('v' | 'i' << 8 | 'r' << 16 | 't' << 24)); |
213 | ||
57ed038a | 214 | dev->qts = qts; |
0a6ed700 MM |
215 | dev->addr = addr; |
216 | dev->page_size = page_size; | |
57ed038a | 217 | dev->vdev.device_type = qtest_readl(qts, addr + QVIRTIO_MMIO_DEVICE_ID); |
6b9cdf4c | 218 | dev->vdev.bus = &qvirtio_mmio; |
0a6ed700 | 219 | |
57ed038a EGE |
220 | qtest_writel(qts, addr + QVIRTIO_MMIO_GUEST_PAGE_SIZE, page_size); |
221 | ||
222 | dev->obj.get_driver = qvirtio_mmio_get_driver; | |
223 | dev->obj.start_hw = qvirtio_mmio_start_hw; | |
224 | } | |
0a6ed700 | 225 | |
57ed038a EGE |
226 | static void virtio_mmio_register_nodes(void) |
227 | { | |
228 | qos_node_create_driver("virtio-mmio", NULL); | |
229 | qos_node_produces("virtio-mmio", "virtio-bus"); | |
0a6ed700 | 230 | } |
57ed038a EGE |
231 | |
232 | libqos_init(virtio_mmio_register_nodes); |