1
2
3
4
5
6
7
8
9
10
11
12
13
14#include "qemu/osdep.h"
15#include "qemu/main-loop.h"
16#include "qemu/module.h"
17#include "qemu/queue.h"
18#include "hw/isa/isa.h"
19#include "hw/hyperv/hyperv.h"
20#include "qom/object.h"
21
22typedef struct TestSintRoute {
23 QLIST_ENTRY(TestSintRoute) le;
24 uint8_t vp_index;
25 uint8_t sint;
26 HvSintRoute *sint_route;
27} TestSintRoute;
28
29typedef struct TestMsgConn {
30 QLIST_ENTRY(TestMsgConn) le;
31 uint8_t conn_id;
32 HvSintRoute *sint_route;
33 struct hyperv_message msg;
34} TestMsgConn;
35
36typedef struct TestEvtConn {
37 QLIST_ENTRY(TestEvtConn) le;
38 uint8_t conn_id;
39 HvSintRoute *sint_route;
40 EventNotifier notifier;
41} TestEvtConn;
42
43struct HypervTestDev {
44 ISADevice parent_obj;
45 MemoryRegion sint_control;
46 QLIST_HEAD(, TestSintRoute) sint_routes;
47 QLIST_HEAD(, TestMsgConn) msg_conns;
48 QLIST_HEAD(, TestEvtConn) evt_conns;
49};
50
51#define TYPE_HYPERV_TEST_DEV "hyperv-testdev"
52OBJECT_DECLARE_SIMPLE_TYPE(HypervTestDev, HYPERV_TEST_DEV)
53
54enum {
55 HV_TEST_DEV_SINT_ROUTE_CREATE = 1,
56 HV_TEST_DEV_SINT_ROUTE_DESTROY,
57 HV_TEST_DEV_SINT_ROUTE_SET_SINT,
58 HV_TEST_DEV_MSG_CONN_CREATE,
59 HV_TEST_DEV_MSG_CONN_DESTROY,
60 HV_TEST_DEV_EVT_CONN_CREATE,
61 HV_TEST_DEV_EVT_CONN_DESTROY,
62};
63
64static void sint_route_create(HypervTestDev *dev,
65 uint8_t vp_index, uint8_t sint)
66{
67 TestSintRoute *sint_route;
68
69 sint_route = g_new0(TestSintRoute, 1);
70 assert(sint_route);
71
72 sint_route->vp_index = vp_index;
73 sint_route->sint = sint;
74
75 sint_route->sint_route = hyperv_sint_route_new(vp_index, sint, NULL, NULL);
76 assert(sint_route->sint_route);
77
78 QLIST_INSERT_HEAD(&dev->sint_routes, sint_route, le);
79}
80
81static TestSintRoute *sint_route_find(HypervTestDev *dev,
82 uint8_t vp_index, uint8_t sint)
83{
84 TestSintRoute *sint_route;
85
86 QLIST_FOREACH(sint_route, &dev->sint_routes, le) {
87 if (sint_route->vp_index == vp_index && sint_route->sint == sint) {
88 return sint_route;
89 }
90 }
91 assert(false);
92 return NULL;
93}
94
95static void sint_route_destroy(HypervTestDev *dev,
96 uint8_t vp_index, uint8_t sint)
97{
98 TestSintRoute *sint_route;
99
100 sint_route = sint_route_find(dev, vp_index, sint);
101 QLIST_REMOVE(sint_route, le);
102 hyperv_sint_route_unref(sint_route->sint_route);
103 g_free(sint_route);
104}
105
106static void sint_route_set_sint(HypervTestDev *dev,
107 uint8_t vp_index, uint8_t sint)
108{
109 TestSintRoute *sint_route;
110
111 sint_route = sint_route_find(dev, vp_index, sint);
112
113 hyperv_sint_route_set_sint(sint_route->sint_route);
114}
115
116static void msg_retry(void *opaque)
117{
118 TestMsgConn *conn = opaque;
119 assert(!hyperv_post_msg(conn->sint_route, &conn->msg));
120}
121
122static void msg_cb(void *data, int status)
123{
124 TestMsgConn *conn = data;
125
126 if (!status) {
127 return;
128 }
129
130 assert(status == -EAGAIN);
131
132 aio_bh_schedule_oneshot(qemu_get_aio_context(), msg_retry, conn);
133}
134
135static uint16_t msg_handler(const struct hyperv_post_message_input *msg,
136 void *data)
137{
138 int ret;
139 TestMsgConn *conn = data;
140
141
142 conn->msg.header.message_type = msg->message_type;
143 assert(msg->payload_size < sizeof(conn->msg.payload));
144 conn->msg.header.payload_size = msg->payload_size;
145 memcpy(&conn->msg.payload, msg->payload, msg->payload_size);
146
147 ret = hyperv_post_msg(conn->sint_route, &conn->msg);
148
149 switch (ret) {
150 case 0:
151 return HV_STATUS_SUCCESS;
152 case -EAGAIN:
153 return HV_STATUS_INSUFFICIENT_BUFFERS;
154 default:
155 return HV_STATUS_INVALID_HYPERCALL_INPUT;
156 }
157}
158
159static void msg_conn_create(HypervTestDev *dev, uint8_t vp_index,
160 uint8_t sint, uint8_t conn_id)
161{
162 TestMsgConn *conn;
163
164 conn = g_new0(TestMsgConn, 1);
165 assert(conn);
166
167 conn->conn_id = conn_id;
168
169 conn->sint_route = hyperv_sint_route_new(vp_index, sint, msg_cb, conn);
170 assert(conn->sint_route);
171
172 assert(!hyperv_set_msg_handler(conn->conn_id, msg_handler, conn));
173
174 QLIST_INSERT_HEAD(&dev->msg_conns, conn, le);
175}
176
177static void msg_conn_destroy(HypervTestDev *dev, uint8_t conn_id)
178{
179 TestMsgConn *conn;
180
181 QLIST_FOREACH(conn, &dev->msg_conns, le) {
182 if (conn->conn_id == conn_id) {
183 QLIST_REMOVE(conn, le);
184 hyperv_set_msg_handler(conn->conn_id, NULL, NULL);
185 hyperv_sint_route_unref(conn->sint_route);
186 g_free(conn);
187 return;
188 }
189 }
190 assert(false);
191}
192
193static void evt_conn_handler(EventNotifier *notifier)
194{
195 TestEvtConn *conn = container_of(notifier, TestEvtConn, notifier);
196
197 event_notifier_test_and_clear(notifier);
198
199
200 assert(!hyperv_set_event_flag(conn->sint_route, conn->conn_id));
201}
202
203static void evt_conn_create(HypervTestDev *dev, uint8_t vp_index,
204 uint8_t sint, uint8_t conn_id)
205{
206 TestEvtConn *conn;
207
208 conn = g_new0(TestEvtConn, 1);
209 assert(conn);
210
211 conn->conn_id = conn_id;
212
213 conn->sint_route = hyperv_sint_route_new(vp_index, sint, NULL, NULL);
214 assert(conn->sint_route);
215
216 assert(!event_notifier_init(&conn->notifier, false));
217
218 event_notifier_set_handler(&conn->notifier, evt_conn_handler);
219
220 assert(!hyperv_set_event_flag_handler(conn_id, &conn->notifier));
221
222 QLIST_INSERT_HEAD(&dev->evt_conns, conn, le);
223}
224
225static void evt_conn_destroy(HypervTestDev *dev, uint8_t conn_id)
226{
227 TestEvtConn *conn;
228
229 QLIST_FOREACH(conn, &dev->evt_conns, le) {
230 if (conn->conn_id == conn_id) {
231 QLIST_REMOVE(conn, le);
232 hyperv_set_event_flag_handler(conn->conn_id, NULL);
233 event_notifier_set_handler(&conn->notifier, NULL);
234 event_notifier_cleanup(&conn->notifier);
235 hyperv_sint_route_unref(conn->sint_route);
236 g_free(conn);
237 return;
238 }
239 }
240 assert(false);
241}
242
243static uint64_t hv_test_dev_read(void *opaque, hwaddr addr, unsigned size)
244{
245 return 0;
246}
247
248static void hv_test_dev_write(void *opaque, hwaddr addr, uint64_t data,
249 uint32_t len)
250{
251 HypervTestDev *dev = HYPERV_TEST_DEV(opaque);
252 uint8_t sint = data & 0xFF;
253 uint8_t vp_index = (data >> 8ULL) & 0xFF;
254 uint8_t ctl = (data >> 16ULL) & 0xFF;
255 uint8_t conn_id = (data >> 24ULL) & 0xFF;
256
257 switch (ctl) {
258 case HV_TEST_DEV_SINT_ROUTE_CREATE:
259 sint_route_create(dev, vp_index, sint);
260 break;
261 case HV_TEST_DEV_SINT_ROUTE_DESTROY:
262 sint_route_destroy(dev, vp_index, sint);
263 break;
264 case HV_TEST_DEV_SINT_ROUTE_SET_SINT:
265 sint_route_set_sint(dev, vp_index, sint);
266 break;
267 case HV_TEST_DEV_MSG_CONN_CREATE:
268 msg_conn_create(dev, vp_index, sint, conn_id);
269 break;
270 case HV_TEST_DEV_MSG_CONN_DESTROY:
271 msg_conn_destroy(dev, conn_id);
272 break;
273 case HV_TEST_DEV_EVT_CONN_CREATE:
274 evt_conn_create(dev, vp_index, sint, conn_id);
275 break;
276 case HV_TEST_DEV_EVT_CONN_DESTROY:
277 evt_conn_destroy(dev, conn_id);
278 break;
279 default:
280 break;
281 }
282}
283
284static const MemoryRegionOps synic_test_sint_ops = {
285 .read = hv_test_dev_read,
286 .write = hv_test_dev_write,
287 .valid.min_access_size = 4,
288 .valid.max_access_size = 4,
289 .endianness = DEVICE_LITTLE_ENDIAN,
290};
291
292static void hv_test_dev_realizefn(DeviceState *d, Error **errp)
293{
294 ISADevice *isa = ISA_DEVICE(d);
295 HypervTestDev *dev = HYPERV_TEST_DEV(d);
296 MemoryRegion *io = isa_address_space_io(isa);
297
298 QLIST_INIT(&dev->sint_routes);
299 QLIST_INIT(&dev->msg_conns);
300 QLIST_INIT(&dev->evt_conns);
301 memory_region_init_io(&dev->sint_control, OBJECT(dev),
302 &synic_test_sint_ops, dev,
303 "hyperv-testdev-ctl", 4);
304 memory_region_add_subregion(io, 0x3000, &dev->sint_control);
305}
306
307static void hv_test_dev_class_init(ObjectClass *klass, void *data)
308{
309 DeviceClass *dc = DEVICE_CLASS(klass);
310
311 set_bit(DEVICE_CATEGORY_MISC, dc->categories);
312 dc->realize = hv_test_dev_realizefn;
313}
314
315static const TypeInfo hv_test_dev_info = {
316 .name = TYPE_HYPERV_TEST_DEV,
317 .parent = TYPE_ISA_DEVICE,
318 .instance_size = sizeof(HypervTestDev),
319 .class_init = hv_test_dev_class_init,
320};
321
322static void hv_test_dev_register_types(void)
323{
324 type_register_static(&hv_test_dev_info);
325}
326type_init(hv_test_dev_register_types);
327
