1*0df750e9SMarc-André Lureau /*
2*0df750e9SMarc-André Lureau  * Vhost User library
3*0df750e9SMarc-André Lureau  *
4*0df750e9SMarc-André Lureau  * Copyright (c) 2016 Nutanix Inc. All rights reserved.
5*0df750e9SMarc-André Lureau  * Copyright (c) 2017 Red Hat, Inc.
6*0df750e9SMarc-André Lureau  *
7*0df750e9SMarc-André Lureau  * Authors:
8*0df750e9SMarc-André Lureau  *  Marc-André Lureau <mlureau@redhat.com>
9*0df750e9SMarc-André Lureau  *  Felipe Franciosi <felipe@nutanix.com>
10*0df750e9SMarc-André Lureau  *
11*0df750e9SMarc-André Lureau  * This work is licensed under the terms of the GNU GPL, version 2 or
12*0df750e9SMarc-André Lureau  * later.  See the COPYING file in the top-level directory.
13*0df750e9SMarc-André Lureau  */
14*0df750e9SMarc-André Lureau 
15*0df750e9SMarc-André Lureau #include "libvhost-user-glib.h"
16*0df750e9SMarc-André Lureau 
17*0df750e9SMarc-André Lureau #ifndef container_of
18*0df750e9SMarc-André Lureau #define container_of(ptr, type, member)              \
19*0df750e9SMarc-André Lureau     __extension__({                                  \
20*0df750e9SMarc-André Lureau         void *__mptr = (void *)(ptr);                \
21*0df750e9SMarc-André Lureau         ((type *)(__mptr - offsetof(type, member))); \
22*0df750e9SMarc-André Lureau     })
23*0df750e9SMarc-André Lureau #endif
24*0df750e9SMarc-André Lureau 
25*0df750e9SMarc-André Lureau /* glib event loop integration for libvhost-user and misc callbacks */
26*0df750e9SMarc-André Lureau 
27*0df750e9SMarc-André Lureau G_STATIC_ASSERT((int)G_IO_IN == (int)VU_WATCH_IN);
28*0df750e9SMarc-André Lureau G_STATIC_ASSERT((int)G_IO_OUT == (int)VU_WATCH_OUT);
29*0df750e9SMarc-André Lureau G_STATIC_ASSERT((int)G_IO_PRI == (int)VU_WATCH_PRI);
30*0df750e9SMarc-André Lureau G_STATIC_ASSERT((int)G_IO_ERR == (int)VU_WATCH_ERR);
31*0df750e9SMarc-André Lureau G_STATIC_ASSERT((int)G_IO_HUP == (int)VU_WATCH_HUP);
32*0df750e9SMarc-André Lureau 
33*0df750e9SMarc-André Lureau typedef struct VugSrc {
34*0df750e9SMarc-André Lureau     GSource parent;
35*0df750e9SMarc-André Lureau     VuDev *dev;
36*0df750e9SMarc-André Lureau     GPollFD gfd;
37*0df750e9SMarc-André Lureau } VugSrc;
38*0df750e9SMarc-André Lureau 
39*0df750e9SMarc-André Lureau static gboolean
vug_src_prepare(GSource * gsrc,gint * timeout)40*0df750e9SMarc-André Lureau vug_src_prepare(GSource *gsrc, gint *timeout)
41*0df750e9SMarc-André Lureau {
42*0df750e9SMarc-André Lureau     g_assert(timeout);
43*0df750e9SMarc-André Lureau 
44*0df750e9SMarc-André Lureau     *timeout = -1;
45*0df750e9SMarc-André Lureau     return FALSE;
46*0df750e9SMarc-André Lureau }
47*0df750e9SMarc-André Lureau 
48*0df750e9SMarc-André Lureau static gboolean
vug_src_check(GSource * gsrc)49*0df750e9SMarc-André Lureau vug_src_check(GSource *gsrc)
50*0df750e9SMarc-André Lureau {
51*0df750e9SMarc-André Lureau     VugSrc *src = (VugSrc *)gsrc;
52*0df750e9SMarc-André Lureau 
53*0df750e9SMarc-André Lureau     g_assert(src);
54*0df750e9SMarc-André Lureau 
55*0df750e9SMarc-André Lureau     return src->gfd.revents & src->gfd.events;
56*0df750e9SMarc-André Lureau }
57*0df750e9SMarc-André Lureau 
58*0df750e9SMarc-André Lureau static gboolean
vug_src_dispatch(GSource * gsrc,GSourceFunc cb,gpointer data)59*0df750e9SMarc-André Lureau vug_src_dispatch(GSource *gsrc, GSourceFunc cb, gpointer data)
60*0df750e9SMarc-André Lureau {
61*0df750e9SMarc-André Lureau     VugSrc *src = (VugSrc *)gsrc;
62*0df750e9SMarc-André Lureau 
63*0df750e9SMarc-André Lureau     g_assert(src);
64*0df750e9SMarc-André Lureau 
65*0df750e9SMarc-André Lureau     ((vu_watch_cb)cb)(src->dev, src->gfd.revents, data);
66*0df750e9SMarc-André Lureau 
67*0df750e9SMarc-André Lureau     return G_SOURCE_CONTINUE;
68*0df750e9SMarc-André Lureau }
69*0df750e9SMarc-André Lureau 
70*0df750e9SMarc-André Lureau static GSourceFuncs vug_src_funcs = {
71*0df750e9SMarc-André Lureau     vug_src_prepare,
72*0df750e9SMarc-André Lureau     vug_src_check,
73*0df750e9SMarc-André Lureau     vug_src_dispatch,
74*0df750e9SMarc-André Lureau     NULL
75*0df750e9SMarc-André Lureau };
76*0df750e9SMarc-André Lureau 
77*0df750e9SMarc-André Lureau GSource *
vug_source_new(VugDev * gdev,int fd,GIOCondition cond,vu_watch_cb vu_cb,gpointer data)78*0df750e9SMarc-André Lureau vug_source_new(VugDev *gdev, int fd, GIOCondition cond,
79*0df750e9SMarc-André Lureau                vu_watch_cb vu_cb, gpointer data)
80*0df750e9SMarc-André Lureau {
81*0df750e9SMarc-André Lureau     VuDev *dev = &gdev->parent;
82*0df750e9SMarc-André Lureau     GSource *gsrc;
83*0df750e9SMarc-André Lureau     VugSrc *src;
84*0df750e9SMarc-André Lureau     guint id;
85*0df750e9SMarc-André Lureau 
86*0df750e9SMarc-André Lureau     g_assert(gdev);
87*0df750e9SMarc-André Lureau     g_assert(fd >= 0);
88*0df750e9SMarc-André Lureau     g_assert(vu_cb);
89*0df750e9SMarc-André Lureau 
90*0df750e9SMarc-André Lureau     gsrc = g_source_new(&vug_src_funcs, sizeof(VugSrc));
91*0df750e9SMarc-André Lureau     g_source_set_callback(gsrc, (GSourceFunc)vu_cb, data, NULL);
92*0df750e9SMarc-André Lureau     src = (VugSrc *)gsrc;
93*0df750e9SMarc-André Lureau     src->dev = dev;
94*0df750e9SMarc-André Lureau     src->gfd.fd = fd;
95*0df750e9SMarc-André Lureau     src->gfd.events = cond;
96*0df750e9SMarc-André Lureau 
97*0df750e9SMarc-André Lureau     g_source_add_poll(gsrc, &src->gfd);
98*0df750e9SMarc-André Lureau     id = g_source_attach(gsrc, g_main_context_get_thread_default());
99*0df750e9SMarc-André Lureau     g_assert(id);
100*0df750e9SMarc-André Lureau 
101*0df750e9SMarc-André Lureau     return gsrc;
102*0df750e9SMarc-André Lureau }
103*0df750e9SMarc-André Lureau 
104*0df750e9SMarc-André Lureau static void
set_watch(VuDev * vu_dev,int fd,int vu_evt,vu_watch_cb cb,void * pvt)105*0df750e9SMarc-André Lureau set_watch(VuDev *vu_dev, int fd, int vu_evt, vu_watch_cb cb, void *pvt)
106*0df750e9SMarc-André Lureau {
107*0df750e9SMarc-André Lureau     GSource *src;
108*0df750e9SMarc-André Lureau     VugDev *dev;
109*0df750e9SMarc-André Lureau 
110*0df750e9SMarc-André Lureau     g_assert(vu_dev);
111*0df750e9SMarc-André Lureau     g_assert(fd >= 0);
112*0df750e9SMarc-André Lureau     g_assert(cb);
113*0df750e9SMarc-André Lureau 
114*0df750e9SMarc-André Lureau     dev = container_of(vu_dev, VugDev, parent);
115*0df750e9SMarc-André Lureau     src = vug_source_new(dev, fd, vu_evt, cb, pvt);
116*0df750e9SMarc-André Lureau     g_hash_table_replace(dev->fdmap, GINT_TO_POINTER(fd), src);
117*0df750e9SMarc-André Lureau }
118*0df750e9SMarc-André Lureau 
119*0df750e9SMarc-André Lureau static void
remove_watch(VuDev * vu_dev,int fd)120*0df750e9SMarc-André Lureau remove_watch(VuDev *vu_dev, int fd)
121*0df750e9SMarc-André Lureau {
122*0df750e9SMarc-André Lureau     VugDev *dev;
123*0df750e9SMarc-André Lureau 
124*0df750e9SMarc-André Lureau     g_assert(vu_dev);
125*0df750e9SMarc-André Lureau     g_assert(fd >= 0);
126*0df750e9SMarc-André Lureau 
127*0df750e9SMarc-André Lureau     dev = container_of(vu_dev, VugDev, parent);
128*0df750e9SMarc-André Lureau     g_hash_table_remove(dev->fdmap, GINT_TO_POINTER(fd));
129*0df750e9SMarc-André Lureau }
130*0df750e9SMarc-André Lureau 
131*0df750e9SMarc-André Lureau 
vug_watch(VuDev * dev,int condition,void * data)132*0df750e9SMarc-André Lureau static void vug_watch(VuDev *dev, int condition, void *data)
133*0df750e9SMarc-André Lureau {
134*0df750e9SMarc-André Lureau     if (!vu_dispatch(dev) != 0) {
135*0df750e9SMarc-André Lureau         dev->panic(dev, "Error processing vhost message");
136*0df750e9SMarc-André Lureau     }
137*0df750e9SMarc-André Lureau }
138*0df750e9SMarc-André Lureau 
vug_source_destroy(GSource * src)139*0df750e9SMarc-André Lureau void vug_source_destroy(GSource *src)
140*0df750e9SMarc-André Lureau {
141*0df750e9SMarc-André Lureau     if (!src) {
142*0df750e9SMarc-André Lureau         return;
143*0df750e9SMarc-André Lureau     }
144*0df750e9SMarc-André Lureau 
145*0df750e9SMarc-André Lureau     g_source_destroy(src);
146*0df750e9SMarc-André Lureau     g_source_unref(src);
147*0df750e9SMarc-André Lureau }
148*0df750e9SMarc-André Lureau 
149*0df750e9SMarc-André Lureau bool
vug_init(VugDev * dev,uint16_t max_queues,int socket,vu_panic_cb panic,const VuDevIface * iface)150*0df750e9SMarc-André Lureau vug_init(VugDev *dev, uint16_t max_queues, int socket,
151*0df750e9SMarc-André Lureau          vu_panic_cb panic, const VuDevIface *iface)
152*0df750e9SMarc-André Lureau {
153*0df750e9SMarc-André Lureau     g_assert(dev);
154*0df750e9SMarc-André Lureau     g_assert(iface);
155*0df750e9SMarc-André Lureau 
156*0df750e9SMarc-André Lureau     if (!vu_init(&dev->parent, max_queues, socket, panic, NULL, set_watch,
157*0df750e9SMarc-André Lureau                  remove_watch, iface)) {
158*0df750e9SMarc-André Lureau         return false;
159*0df750e9SMarc-André Lureau     }
160*0df750e9SMarc-André Lureau 
161*0df750e9SMarc-André Lureau     dev->fdmap = g_hash_table_new_full(NULL, NULL, NULL,
162*0df750e9SMarc-André Lureau                                        (GDestroyNotify) vug_source_destroy);
163*0df750e9SMarc-André Lureau 
164*0df750e9SMarc-André Lureau     dev->src = vug_source_new(dev, socket, G_IO_IN, vug_watch, NULL);
165*0df750e9SMarc-André Lureau 
166*0df750e9SMarc-André Lureau     return true;
167*0df750e9SMarc-André Lureau }
168*0df750e9SMarc-André Lureau 
169*0df750e9SMarc-André Lureau void
vug_deinit(VugDev * dev)170*0df750e9SMarc-André Lureau vug_deinit(VugDev *dev)
171*0df750e9SMarc-André Lureau {
172*0df750e9SMarc-André Lureau     g_assert(dev);
173*0df750e9SMarc-André Lureau 
174*0df750e9SMarc-André Lureau     g_hash_table_unref(dev->fdmap);
175*0df750e9SMarc-André Lureau     vug_source_destroy(dev->src);
176*0df750e9SMarc-André Lureau }
177