xref: /openbmc/qemu/io/channel-websock.c (revision 0c4a94b8)
1 /*
2  * QEMU I/O channels driver websockets
3  *
4  * Copyright (c) 2015 Red Hat, Inc.
5  *
6  * This library is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Lesser General Public
8  * License as published by the Free Software Foundation; either
9  * version 2 of the License, or (at your option) any later version.
10  *
11  * This library is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public
17  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
18  *
19  */
20 
21 #include "qemu/osdep.h"
22 #include "qapi/error.h"
23 #include "qemu/bswap.h"
24 #include "io/channel-websock.h"
25 #include "crypto/hash.h"
26 #include "trace.h"
27 #include "qemu/iov.h"
28 
29 /* Max amount to allow in rawinput/encoutput buffers */
30 #define QIO_CHANNEL_WEBSOCK_MAX_BUFFER 8192
31 
32 #define QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN 24
33 #define QIO_CHANNEL_WEBSOCK_GUID "258EAFA5-E914-47DA-95CA-C5AB0DC85B11"
34 #define QIO_CHANNEL_WEBSOCK_GUID_LEN strlen(QIO_CHANNEL_WEBSOCK_GUID)
35 
36 #define QIO_CHANNEL_WEBSOCK_HEADER_PROTOCOL "sec-websocket-protocol"
37 #define QIO_CHANNEL_WEBSOCK_HEADER_VERSION "sec-websocket-version"
38 #define QIO_CHANNEL_WEBSOCK_HEADER_KEY "sec-websocket-key"
39 #define QIO_CHANNEL_WEBSOCK_HEADER_UPGRADE "upgrade"
40 #define QIO_CHANNEL_WEBSOCK_HEADER_HOST "host"
41 #define QIO_CHANNEL_WEBSOCK_HEADER_CONNECTION "connection"
42 
43 #define QIO_CHANNEL_WEBSOCK_PROTOCOL_BINARY "binary"
44 #define QIO_CHANNEL_WEBSOCK_CONNECTION_UPGRADE "Upgrade"
45 #define QIO_CHANNEL_WEBSOCK_UPGRADE_WEBSOCKET "websocket"
46 
47 #define QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_COMMON \
48     "Server: QEMU VNC\r\n"                       \
49     "Date: %s\r\n"
50 
51 #define QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_OK    \
52     "HTTP/1.1 101 Switching Protocols\r\n"      \
53     QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_COMMON    \
54     "Upgrade: websocket\r\n"                    \
55     "Connection: Upgrade\r\n"                   \
56     "Sec-WebSocket-Accept: %s\r\n"              \
57     "Sec-WebSocket-Protocol: binary\r\n"        \
58     "\r\n"
59 #define QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_NOT_FOUND \
60     "HTTP/1.1 404 Not Found\r\n"                    \
61     QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_COMMON        \
62     "Connection: close\r\n"                         \
63     "\r\n"
64 #define QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_BAD_REQUEST \
65     "HTTP/1.1 400 Bad Request\r\n"                    \
66     QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_COMMON          \
67     "Connection: close\r\n"                           \
68     "Sec-WebSocket-Version: "                         \
69     QIO_CHANNEL_WEBSOCK_SUPPORTED_VERSION             \
70     "\r\n"
71 #define QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_SERVER_ERR \
72     "HTTP/1.1 500 Internal Server Error\r\n"         \
73     QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_COMMON         \
74     "Connection: close\r\n"                          \
75     "\r\n"
76 #define QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_TOO_LARGE  \
77     "HTTP/1.1 403 Request Entity Too Large\r\n"      \
78     QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_COMMON         \
79     "Connection: close\r\n"                          \
80     "\r\n"
81 #define QIO_CHANNEL_WEBSOCK_HANDSHAKE_DELIM "\r\n"
82 #define QIO_CHANNEL_WEBSOCK_HANDSHAKE_END "\r\n\r\n"
83 #define QIO_CHANNEL_WEBSOCK_SUPPORTED_VERSION "13"
84 #define QIO_CHANNEL_WEBSOCK_HTTP_METHOD "GET"
85 #define QIO_CHANNEL_WEBSOCK_HTTP_PATH "/"
86 #define QIO_CHANNEL_WEBSOCK_HTTP_VERSION "HTTP/1.1"
87 
88 /* The websockets packet header is variable length
89  * depending on the size of the payload... */
90 
91 /* ...length when using 7-bit payload length */
92 #define QIO_CHANNEL_WEBSOCK_HEADER_LEN_7_BIT 6
93 /* ...length when using 16-bit payload length */
94 #define QIO_CHANNEL_WEBSOCK_HEADER_LEN_16_BIT 8
95 /* ...length when using 64-bit payload length */
96 #define QIO_CHANNEL_WEBSOCK_HEADER_LEN_64_BIT 14
97 
98 /* Length of the optional data mask field in header */
99 #define QIO_CHANNEL_WEBSOCK_HEADER_LEN_MASK 4
100 
101 /* Maximum length that can fit in 7-bit payload size */
102 #define QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_THRESHOLD_7_BIT 126
103 /* Maximum length that can fit in 16-bit payload size */
104 #define QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_THRESHOLD_16_BIT 65536
105 
106 /* Magic 7-bit length to indicate use of 16-bit payload length */
107 #define QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_16_BIT 126
108 /* Magic 7-bit length to indicate use of 64-bit payload length */
109 #define QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_64_BIT 127
110 
111 /* Bitmasks for accessing header fields */
112 #define QIO_CHANNEL_WEBSOCK_HEADER_FIELD_FIN 0x80
113 #define QIO_CHANNEL_WEBSOCK_HEADER_FIELD_OPCODE 0x0f
114 #define QIO_CHANNEL_WEBSOCK_HEADER_FIELD_HAS_MASK 0x80
115 #define QIO_CHANNEL_WEBSOCK_HEADER_FIELD_PAYLOAD_LEN 0x7f
116 #define QIO_CHANNEL_WEBSOCK_CONTROL_OPCODE_MASK 0x8
117 
118 typedef struct QIOChannelWebsockHeader QIOChannelWebsockHeader;
119 
120 struct QEMU_PACKED QIOChannelWebsockHeader {
121     unsigned char b0;
122     unsigned char b1;
123     union {
124         struct QEMU_PACKED {
125             uint16_t l16;
126             QIOChannelWebsockMask m16;
127         } s16;
128         struct QEMU_PACKED {
129             uint64_t l64;
130             QIOChannelWebsockMask m64;
131         } s64;
132         QIOChannelWebsockMask m;
133     } u;
134 };
135 
136 typedef struct QIOChannelWebsockHTTPHeader QIOChannelWebsockHTTPHeader;
137 
138 struct QIOChannelWebsockHTTPHeader {
139     char *name;
140     char *value;
141 };
142 
143 enum {
144     QIO_CHANNEL_WEBSOCK_OPCODE_CONTINUATION = 0x0,
145     QIO_CHANNEL_WEBSOCK_OPCODE_TEXT_FRAME = 0x1,
146     QIO_CHANNEL_WEBSOCK_OPCODE_BINARY_FRAME = 0x2,
147     QIO_CHANNEL_WEBSOCK_OPCODE_CLOSE = 0x8,
148     QIO_CHANNEL_WEBSOCK_OPCODE_PING = 0x9,
149     QIO_CHANNEL_WEBSOCK_OPCODE_PONG = 0xA
150 };
151 
152 static void GCC_FMT_ATTR(2, 3)
153 qio_channel_websock_handshake_send_res(QIOChannelWebsock *ioc,
154                                        const char *resmsg,
155                                        ...)
156 {
157     va_list vargs;
158     char *response;
159     size_t responselen;
160 
161     va_start(vargs, resmsg);
162     response = g_strdup_vprintf(resmsg, vargs);
163     responselen = strlen(response);
164     buffer_reserve(&ioc->encoutput, responselen);
165     buffer_append(&ioc->encoutput, response, responselen);
166     va_end(vargs);
167 }
168 
169 static gchar *qio_channel_websock_date_str(void)
170 {
171     struct tm tm;
172     time_t now = time(NULL);
173     char datebuf[128];
174 
175     gmtime_r(&now, &tm);
176 
177     strftime(datebuf, sizeof(datebuf), "%a, %d %b %Y %H:%M:%S GMT", &tm);
178 
179     return g_strdup(datebuf);
180 }
181 
182 static void qio_channel_websock_handshake_send_res_err(QIOChannelWebsock *ioc,
183                                                        const char *resdata)
184 {
185     char *date = qio_channel_websock_date_str();
186     qio_channel_websock_handshake_send_res(ioc, resdata, date);
187     g_free(date);
188 }
189 
190 enum {
191     QIO_CHANNEL_WEBSOCK_STATUS_NORMAL = 1000,
192     QIO_CHANNEL_WEBSOCK_STATUS_PROTOCOL_ERR = 1002,
193     QIO_CHANNEL_WEBSOCK_STATUS_INVALID_DATA = 1003,
194     QIO_CHANNEL_WEBSOCK_STATUS_POLICY = 1008,
195     QIO_CHANNEL_WEBSOCK_STATUS_TOO_LARGE = 1009,
196     QIO_CHANNEL_WEBSOCK_STATUS_SERVER_ERR = 1011,
197 };
198 
199 static size_t
200 qio_channel_websock_extract_headers(QIOChannelWebsock *ioc,
201                                     char *buffer,
202                                     QIOChannelWebsockHTTPHeader *hdrs,
203                                     size_t nhdrsalloc,
204                                     Error **errp)
205 {
206     char *nl, *sep, *tmp;
207     size_t nhdrs = 0;
208 
209     /*
210      * First parse the HTTP protocol greeting of format:
211      *
212      *   $METHOD $PATH $VERSION
213      *
214      * e.g.
215      *
216      *   GET / HTTP/1.1
217      */
218 
219     nl = strstr(buffer, QIO_CHANNEL_WEBSOCK_HANDSHAKE_DELIM);
220     if (!nl) {
221         error_setg(errp, "Missing HTTP header delimiter");
222         goto bad_request;
223     }
224     *nl = '\0';
225     trace_qio_channel_websock_http_greeting(ioc, buffer);
226 
227     tmp = strchr(buffer, ' ');
228     if (!tmp) {
229         error_setg(errp, "Missing HTTP path delimiter");
230         return 0;
231     }
232     *tmp = '\0';
233 
234     if (!g_str_equal(buffer, QIO_CHANNEL_WEBSOCK_HTTP_METHOD)) {
235         error_setg(errp, "Unsupported HTTP method %s", buffer);
236         goto bad_request;
237     }
238 
239     buffer = tmp + 1;
240     tmp = strchr(buffer, ' ');
241     if (!tmp) {
242         error_setg(errp, "Missing HTTP version delimiter");
243         goto bad_request;
244     }
245     *tmp = '\0';
246 
247     if (!g_str_equal(buffer, QIO_CHANNEL_WEBSOCK_HTTP_PATH)) {
248         qio_channel_websock_handshake_send_res_err(
249             ioc, QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_NOT_FOUND);
250         error_setg(errp, "Unexpected HTTP path %s", buffer);
251         return 0;
252     }
253 
254     buffer = tmp + 1;
255 
256     if (!g_str_equal(buffer, QIO_CHANNEL_WEBSOCK_HTTP_VERSION)) {
257         error_setg(errp, "Unsupported HTTP version %s", buffer);
258         goto bad_request;
259     }
260 
261     buffer = nl + strlen(QIO_CHANNEL_WEBSOCK_HANDSHAKE_DELIM);
262 
263     /*
264      * Now parse all the header fields of format
265      *
266      *   $NAME: $VALUE
267      *
268      * e.g.
269      *
270      *   Cache-control: no-cache
271      */
272     do {
273         QIOChannelWebsockHTTPHeader *hdr;
274 
275         nl = strstr(buffer, QIO_CHANNEL_WEBSOCK_HANDSHAKE_DELIM);
276         if (nl) {
277             *nl = '\0';
278         }
279 
280         sep = strchr(buffer, ':');
281         if (!sep) {
282             error_setg(errp, "Malformed HTTP header");
283             goto bad_request;
284         }
285         *sep = '\0';
286         sep++;
287         while (*sep == ' ') {
288             sep++;
289         }
290 
291         if (nhdrs >= nhdrsalloc) {
292             error_setg(errp, "Too many HTTP headers");
293             goto bad_request;
294         }
295 
296         hdr = &hdrs[nhdrs++];
297         hdr->name = buffer;
298         hdr->value = sep;
299 
300         /* Canonicalize header name for easier identification later */
301         for (tmp = hdr->name; *tmp; tmp++) {
302             *tmp = g_ascii_tolower(*tmp);
303         }
304 
305         if (nl) {
306             buffer = nl + strlen(QIO_CHANNEL_WEBSOCK_HANDSHAKE_DELIM);
307         }
308     } while (nl != NULL);
309 
310     return nhdrs;
311 
312  bad_request:
313     qio_channel_websock_handshake_send_res_err(
314         ioc, QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_BAD_REQUEST);
315     return 0;
316 }
317 
318 static const char *
319 qio_channel_websock_find_header(QIOChannelWebsockHTTPHeader *hdrs,
320                                 size_t nhdrs,
321                                 const char *name)
322 {
323     size_t i;
324 
325     for (i = 0; i < nhdrs; i++) {
326         if (g_str_equal(hdrs[i].name, name)) {
327             return hdrs[i].value;
328         }
329     }
330 
331     return NULL;
332 }
333 
334 
335 static void qio_channel_websock_handshake_send_res_ok(QIOChannelWebsock *ioc,
336                                                       const char *key,
337                                                       Error **errp)
338 {
339     char combined_key[QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN +
340                       QIO_CHANNEL_WEBSOCK_GUID_LEN + 1];
341     char *accept = NULL;
342     char *date = NULL;
343 
344     g_strlcpy(combined_key, key, QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN + 1);
345     g_strlcat(combined_key, QIO_CHANNEL_WEBSOCK_GUID,
346               QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN +
347               QIO_CHANNEL_WEBSOCK_GUID_LEN + 1);
348 
349     /* hash and encode it */
350     if (qcrypto_hash_base64(QCRYPTO_HASH_ALG_SHA1,
351                             combined_key,
352                             QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN +
353                             QIO_CHANNEL_WEBSOCK_GUID_LEN,
354                             &accept,
355                             errp) < 0) {
356         qio_channel_websock_handshake_send_res_err(
357             ioc, QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_SERVER_ERR);
358         return;
359     }
360 
361     date = qio_channel_websock_date_str();
362     qio_channel_websock_handshake_send_res(
363         ioc, QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_OK, date, accept);
364 
365     g_free(date);
366     g_free(accept);
367 }
368 
369 static void qio_channel_websock_handshake_process(QIOChannelWebsock *ioc,
370                                                   char *buffer,
371                                                   Error **errp)
372 {
373     QIOChannelWebsockHTTPHeader hdrs[32];
374     size_t nhdrs = G_N_ELEMENTS(hdrs);
375     const char *protocols = NULL, *version = NULL, *key = NULL,
376         *host = NULL, *connection = NULL, *upgrade = NULL;
377     char **connectionv;
378     bool upgraded = false;
379     size_t i;
380 
381     nhdrs = qio_channel_websock_extract_headers(ioc, buffer, hdrs, nhdrs, errp);
382     if (!nhdrs) {
383         return;
384     }
385 
386     protocols = qio_channel_websock_find_header(
387         hdrs, nhdrs, QIO_CHANNEL_WEBSOCK_HEADER_PROTOCOL);
388     if (!protocols) {
389         error_setg(errp, "Missing websocket protocol header data");
390         goto bad_request;
391     }
392 
393     version = qio_channel_websock_find_header(
394         hdrs, nhdrs, QIO_CHANNEL_WEBSOCK_HEADER_VERSION);
395     if (!version) {
396         error_setg(errp, "Missing websocket version header data");
397         goto bad_request;
398     }
399 
400     key = qio_channel_websock_find_header(
401         hdrs, nhdrs, QIO_CHANNEL_WEBSOCK_HEADER_KEY);
402     if (!key) {
403         error_setg(errp, "Missing websocket key header data");
404         goto bad_request;
405     }
406 
407     host = qio_channel_websock_find_header(
408         hdrs, nhdrs, QIO_CHANNEL_WEBSOCK_HEADER_HOST);
409     if (!host) {
410         error_setg(errp, "Missing websocket host header data");
411         goto bad_request;
412     }
413 
414     connection = qio_channel_websock_find_header(
415         hdrs, nhdrs, QIO_CHANNEL_WEBSOCK_HEADER_CONNECTION);
416     if (!connection) {
417         error_setg(errp, "Missing websocket connection header data");
418         goto bad_request;
419     }
420 
421     upgrade = qio_channel_websock_find_header(
422         hdrs, nhdrs, QIO_CHANNEL_WEBSOCK_HEADER_UPGRADE);
423     if (!upgrade) {
424         error_setg(errp, "Missing websocket upgrade header data");
425         goto bad_request;
426     }
427 
428     trace_qio_channel_websock_http_request(ioc, protocols, version,
429                                            host, connection, upgrade, key);
430 
431     if (!g_strrstr(protocols, QIO_CHANNEL_WEBSOCK_PROTOCOL_BINARY)) {
432         error_setg(errp, "No '%s' protocol is supported by client '%s'",
433                    QIO_CHANNEL_WEBSOCK_PROTOCOL_BINARY, protocols);
434         goto bad_request;
435     }
436 
437     if (!g_str_equal(version, QIO_CHANNEL_WEBSOCK_SUPPORTED_VERSION)) {
438         error_setg(errp, "Version '%s' is not supported by client '%s'",
439                    QIO_CHANNEL_WEBSOCK_SUPPORTED_VERSION, version);
440         goto bad_request;
441     }
442 
443     if (strlen(key) != QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN) {
444         error_setg(errp, "Key length '%zu' was not as expected '%d'",
445                    strlen(key), QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN);
446         goto bad_request;
447     }
448 
449     connectionv = g_strsplit(connection, ",", 0);
450     for (i = 0; connectionv != NULL && connectionv[i] != NULL; i++) {
451         g_strstrip(connectionv[i]);
452         if (strcasecmp(connectionv[i],
453                        QIO_CHANNEL_WEBSOCK_CONNECTION_UPGRADE) == 0) {
454             upgraded = true;
455         }
456     }
457     g_strfreev(connectionv);
458     if (!upgraded) {
459         error_setg(errp, "No connection upgrade requested '%s'", connection);
460         goto bad_request;
461     }
462 
463     if (strcasecmp(upgrade, QIO_CHANNEL_WEBSOCK_UPGRADE_WEBSOCKET) != 0) {
464         error_setg(errp, "Incorrect upgrade method '%s'", upgrade);
465         goto bad_request;
466     }
467 
468     qio_channel_websock_handshake_send_res_ok(ioc, key, errp);
469     return;
470 
471  bad_request:
472     qio_channel_websock_handshake_send_res_err(
473         ioc, QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_BAD_REQUEST);
474 }
475 
476 static int qio_channel_websock_handshake_read(QIOChannelWebsock *ioc,
477                                               Error **errp)
478 {
479     char *handshake_end;
480     ssize_t ret;
481     /* Typical HTTP headers from novnc are 512 bytes, so limiting
482      * total header size to 4096 is easily enough. */
483     size_t want = 4096 - ioc->encinput.offset;
484     buffer_reserve(&ioc->encinput, want);
485     ret = qio_channel_read(ioc->master,
486                            (char *)buffer_end(&ioc->encinput), want, errp);
487     if (ret < 0) {
488         return -1;
489     }
490     ioc->encinput.offset += ret;
491 
492     handshake_end = g_strstr_len((char *)ioc->encinput.buffer,
493                                  ioc->encinput.offset,
494                                  QIO_CHANNEL_WEBSOCK_HANDSHAKE_END);
495     if (!handshake_end) {
496         if (ioc->encinput.offset >= 4096) {
497             qio_channel_websock_handshake_send_res_err(
498                 ioc, QIO_CHANNEL_WEBSOCK_HANDSHAKE_RES_TOO_LARGE);
499             error_setg(errp,
500                        "End of headers not found in first 4096 bytes");
501             return 1;
502         } else if (ret == 0) {
503             error_setg(errp,
504                        "End of headers not found before connection closed");
505             return -1;
506         }
507         return 0;
508     }
509     *handshake_end = '\0';
510 
511     qio_channel_websock_handshake_process(ioc,
512                                           (char *)ioc->encinput.buffer,
513                                           errp);
514 
515     buffer_advance(&ioc->encinput,
516                    handshake_end - (char *)ioc->encinput.buffer +
517                    strlen(QIO_CHANNEL_WEBSOCK_HANDSHAKE_END));
518     return 1;
519 }
520 
521 static gboolean qio_channel_websock_handshake_send(QIOChannel *ioc,
522                                                    GIOCondition condition,
523                                                    gpointer user_data)
524 {
525     QIOTask *task = user_data;
526     QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(
527         qio_task_get_source(task));
528     Error *err = NULL;
529     ssize_t ret;
530 
531     ret = qio_channel_write(wioc->master,
532                             (char *)wioc->encoutput.buffer,
533                             wioc->encoutput.offset,
534                             &err);
535 
536     if (ret < 0) {
537         trace_qio_channel_websock_handshake_fail(ioc, error_get_pretty(err));
538         qio_task_set_error(task, err);
539         qio_task_complete(task);
540         return FALSE;
541     }
542 
543     buffer_advance(&wioc->encoutput, ret);
544     if (wioc->encoutput.offset == 0) {
545         if (wioc->io_err) {
546             trace_qio_channel_websock_handshake_fail(
547                 ioc, error_get_pretty(wioc->io_err));
548             qio_task_set_error(task, wioc->io_err);
549             wioc->io_err = NULL;
550             qio_task_complete(task);
551         } else {
552             trace_qio_channel_websock_handshake_complete(ioc);
553             qio_task_complete(task);
554         }
555         return FALSE;
556     }
557     trace_qio_channel_websock_handshake_pending(ioc, G_IO_OUT);
558     return TRUE;
559 }
560 
561 static gboolean qio_channel_websock_handshake_io(QIOChannel *ioc,
562                                                  GIOCondition condition,
563                                                  gpointer user_data)
564 {
565     QIOTask *task = user_data;
566     QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(
567         qio_task_get_source(task));
568     Error *err = NULL;
569     int ret;
570 
571     ret = qio_channel_websock_handshake_read(wioc, &err);
572     if (ret < 0) {
573         /*
574          * We only take this path on a fatal I/O error reading from
575          * client connection, as most of the time we have an
576          * HTTP 4xx err response to send instead
577          */
578         trace_qio_channel_websock_handshake_fail(ioc, error_get_pretty(err));
579         qio_task_set_error(task, err);
580         qio_task_complete(task);
581         return FALSE;
582     }
583     if (ret == 0) {
584         trace_qio_channel_websock_handshake_pending(ioc, G_IO_IN);
585         /* need more data still */
586         return TRUE;
587     }
588 
589     if (err) {
590         error_propagate(&wioc->io_err, err);
591     }
592 
593     trace_qio_channel_websock_handshake_reply(ioc);
594     qio_channel_add_watch(
595         wioc->master,
596         G_IO_OUT,
597         qio_channel_websock_handshake_send,
598         task,
599         NULL);
600     return FALSE;
601 }
602 
603 
604 static void qio_channel_websock_encode(QIOChannelWebsock *ioc,
605                                        uint8_t opcode,
606                                        const struct iovec *iov,
607                                        size_t niov,
608                                        size_t size)
609 {
610     size_t header_size;
611     size_t i;
612     union {
613         char buf[QIO_CHANNEL_WEBSOCK_HEADER_LEN_64_BIT];
614         QIOChannelWebsockHeader ws;
615     } header;
616 
617     assert(size <= iov_size(iov, niov));
618 
619     header.ws.b0 = QIO_CHANNEL_WEBSOCK_HEADER_FIELD_FIN |
620         (opcode & QIO_CHANNEL_WEBSOCK_HEADER_FIELD_OPCODE);
621     if (size < QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_THRESHOLD_7_BIT) {
622         header.ws.b1 = (uint8_t)size;
623         header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_7_BIT;
624     } else if (size < QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_THRESHOLD_16_BIT) {
625         header.ws.b1 = QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_16_BIT;
626         header.ws.u.s16.l16 = cpu_to_be16((uint16_t)size);
627         header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_16_BIT;
628     } else {
629         header.ws.b1 = QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_64_BIT;
630         header.ws.u.s64.l64 = cpu_to_be64(size);
631         header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_64_BIT;
632     }
633     header_size -= QIO_CHANNEL_WEBSOCK_HEADER_LEN_MASK;
634 
635     trace_qio_channel_websock_encode(ioc, opcode, header_size, size);
636     buffer_reserve(&ioc->encoutput, header_size + size);
637     buffer_append(&ioc->encoutput, header.buf, header_size);
638     for (i = 0; i < niov && size != 0; i++) {
639         size_t want = iov[i].iov_len;
640         if (want > size) {
641             want = size;
642         }
643         buffer_append(&ioc->encoutput, iov[i].iov_base, want);
644         size -= want;
645     }
646 }
647 
648 
649 static ssize_t qio_channel_websock_write_wire(QIOChannelWebsock *, Error **);
650 
651 
652 static void qio_channel_websock_write_close(QIOChannelWebsock *ioc,
653                                             uint16_t code, const char *reason)
654 {
655     struct iovec iov[2] = {
656         { .iov_base = &code, .iov_len = sizeof(code) },
657     };
658     size_t niov = 1;
659     size_t size = iov[0].iov_len;
660 
661     cpu_to_be16s(&code);
662 
663     if (reason) {
664         iov[1].iov_base = (void *)reason;
665         iov[1].iov_len = strlen(reason);
666         size += iov[1].iov_len;
667         niov++;
668     }
669     qio_channel_websock_encode(ioc, QIO_CHANNEL_WEBSOCK_OPCODE_CLOSE,
670                                iov, niov, size);
671     qio_channel_websock_write_wire(ioc, NULL);
672     qio_channel_shutdown(ioc->master, QIO_CHANNEL_SHUTDOWN_BOTH, NULL);
673 }
674 
675 
676 static int qio_channel_websock_decode_header(QIOChannelWebsock *ioc,
677                                              Error **errp)
678 {
679     unsigned char opcode, fin, has_mask;
680     size_t header_size;
681     size_t payload_len;
682     QIOChannelWebsockHeader *header =
683         (QIOChannelWebsockHeader *)ioc->encinput.buffer;
684 
685     if (ioc->payload_remain) {
686         error_setg(errp,
687                    "Decoding header but %zu bytes of payload remain",
688                    ioc->payload_remain);
689         qio_channel_websock_write_close(
690             ioc, QIO_CHANNEL_WEBSOCK_STATUS_SERVER_ERR,
691             "internal server error");
692         return -1;
693     }
694     if (ioc->encinput.offset < QIO_CHANNEL_WEBSOCK_HEADER_LEN_7_BIT) {
695         /* header not complete */
696         return QIO_CHANNEL_ERR_BLOCK;
697     }
698 
699     fin = header->b0 & QIO_CHANNEL_WEBSOCK_HEADER_FIELD_FIN;
700     opcode = header->b0 & QIO_CHANNEL_WEBSOCK_HEADER_FIELD_OPCODE;
701     has_mask = header->b1 & QIO_CHANNEL_WEBSOCK_HEADER_FIELD_HAS_MASK;
702     payload_len = header->b1 & QIO_CHANNEL_WEBSOCK_HEADER_FIELD_PAYLOAD_LEN;
703 
704     /* Save or restore opcode. */
705     if (opcode) {
706         ioc->opcode = opcode;
707     } else {
708         opcode = ioc->opcode;
709     }
710 
711     trace_qio_channel_websock_header_partial_decode(ioc, payload_len,
712                                                     fin, opcode, (int)has_mask);
713 
714     if (opcode == QIO_CHANNEL_WEBSOCK_OPCODE_CLOSE) {
715         /* disconnect */
716         return 0;
717     }
718 
719     /* Websocket frame sanity check:
720      * * Fragmentation is only supported for binary frames.
721      * * All frames sent by a client MUST be masked.
722      * * Only binary and ping/pong encoding is supported.
723      */
724     if (!fin) {
725         if (opcode != QIO_CHANNEL_WEBSOCK_OPCODE_BINARY_FRAME) {
726             error_setg(errp, "only binary websocket frames may be fragmented");
727             qio_channel_websock_write_close(
728                 ioc, QIO_CHANNEL_WEBSOCK_STATUS_POLICY ,
729                 "only binary frames may be fragmented");
730             return -1;
731         }
732     } else {
733         if (opcode != QIO_CHANNEL_WEBSOCK_OPCODE_BINARY_FRAME &&
734             opcode != QIO_CHANNEL_WEBSOCK_OPCODE_CLOSE &&
735             opcode != QIO_CHANNEL_WEBSOCK_OPCODE_PING &&
736             opcode != QIO_CHANNEL_WEBSOCK_OPCODE_PONG) {
737             error_setg(errp, "unsupported opcode: %#04x; only binary, close, "
738                        "ping, and pong websocket frames are supported", opcode);
739             qio_channel_websock_write_close(
740                 ioc, QIO_CHANNEL_WEBSOCK_STATUS_INVALID_DATA ,
741                 "only binary, close, ping, and pong frames are supported");
742             return -1;
743         }
744     }
745     if (!has_mask) {
746         error_setg(errp, "client websocket frames must be masked");
747         qio_channel_websock_write_close(
748             ioc, QIO_CHANNEL_WEBSOCK_STATUS_PROTOCOL_ERR,
749             "client frames must be masked");
750         return -1;
751     }
752 
753     if (payload_len < QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_16_BIT) {
754         ioc->payload_remain = payload_len;
755         header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_7_BIT;
756         ioc->mask = header->u.m;
757     } else if (opcode & QIO_CHANNEL_WEBSOCK_CONTROL_OPCODE_MASK) {
758         error_setg(errp, "websocket control frame is too large");
759         qio_channel_websock_write_close(
760             ioc, QIO_CHANNEL_WEBSOCK_STATUS_PROTOCOL_ERR,
761             "control frame is too large");
762         return -1;
763     } else if (payload_len == QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_16_BIT &&
764                ioc->encinput.offset >= QIO_CHANNEL_WEBSOCK_HEADER_LEN_16_BIT) {
765         ioc->payload_remain = be16_to_cpu(header->u.s16.l16);
766         header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_16_BIT;
767         ioc->mask = header->u.s16.m16;
768     } else if (payload_len == QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_64_BIT &&
769                ioc->encinput.offset >= QIO_CHANNEL_WEBSOCK_HEADER_LEN_64_BIT) {
770         ioc->payload_remain = be64_to_cpu(header->u.s64.l64);
771         header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_64_BIT;
772         ioc->mask = header->u.s64.m64;
773     } else {
774         /* header not complete */
775         return QIO_CHANNEL_ERR_BLOCK;
776     }
777 
778     trace_qio_channel_websock_header_full_decode(
779         ioc, header_size, ioc->payload_remain, ioc->mask.u);
780     buffer_advance(&ioc->encinput, header_size);
781     return 0;
782 }
783 
784 
785 static int qio_channel_websock_decode_payload(QIOChannelWebsock *ioc,
786                                               Error **errp)
787 {
788     size_t i;
789     size_t payload_len = 0;
790     uint32_t *payload32;
791 
792     if (ioc->payload_remain) {
793         /* If we aren't at the end of the payload, then drop
794          * off the last bytes, so we're always multiple of 4
795          * for purpose of unmasking, except at end of payload
796          */
797         if (ioc->encinput.offset < ioc->payload_remain) {
798             /* Wait for the entire payload before processing control frames
799              * because the payload will most likely be echoed back. */
800             if (ioc->opcode & QIO_CHANNEL_WEBSOCK_CONTROL_OPCODE_MASK) {
801                 return QIO_CHANNEL_ERR_BLOCK;
802             }
803             payload_len = ioc->encinput.offset - (ioc->encinput.offset % 4);
804         } else {
805             payload_len = ioc->payload_remain;
806         }
807         if (payload_len == 0) {
808             return QIO_CHANNEL_ERR_BLOCK;
809         }
810 
811         ioc->payload_remain -= payload_len;
812 
813         /* unmask frame */
814         /* process 1 frame (32 bit op) */
815         payload32 = (uint32_t *)ioc->encinput.buffer;
816         for (i = 0; i < payload_len / 4; i++) {
817             payload32[i] ^= ioc->mask.u;
818         }
819         /* process the remaining bytes (if any) */
820         for (i *= 4; i < payload_len; i++) {
821             ioc->encinput.buffer[i] ^= ioc->mask.c[i % 4];
822         }
823     }
824 
825     trace_qio_channel_websock_payload_decode(
826         ioc, ioc->opcode, ioc->payload_remain);
827 
828     if (ioc->opcode == QIO_CHANNEL_WEBSOCK_OPCODE_BINARY_FRAME) {
829         if (payload_len) {
830             /* binary frames are passed on */
831             buffer_reserve(&ioc->rawinput, payload_len);
832             buffer_append(&ioc->rawinput, ioc->encinput.buffer, payload_len);
833         }
834     } else if (ioc->opcode == QIO_CHANNEL_WEBSOCK_OPCODE_CLOSE) {
835         /* close frames are echoed back */
836         error_setg(errp, "websocket closed by peer");
837         if (payload_len) {
838             /* echo client status */
839             struct iovec iov = { .iov_base = ioc->encinput.buffer,
840                                  .iov_len = ioc->encinput.offset };
841             qio_channel_websock_encode(ioc, QIO_CHANNEL_WEBSOCK_OPCODE_CLOSE,
842                                        &iov, 1, iov.iov_len);
843             qio_channel_websock_write_wire(ioc, NULL);
844             qio_channel_shutdown(ioc->master, QIO_CHANNEL_SHUTDOWN_BOTH, NULL);
845         } else {
846             /* send our own status */
847             qio_channel_websock_write_close(
848                 ioc, QIO_CHANNEL_WEBSOCK_STATUS_NORMAL, "peer requested close");
849         }
850         return -1;
851     } else if (ioc->opcode == QIO_CHANNEL_WEBSOCK_OPCODE_PING) {
852         /* ping frames produce an immediate reply, as long as we've not still
853          * got a previous pong queued, in which case we drop the new pong */
854         if (ioc->pong_remain == 0) {
855             struct iovec iov = { .iov_base = ioc->encinput.buffer,
856                                  .iov_len = ioc->encinput.offset };
857             qio_channel_websock_encode(ioc, QIO_CHANNEL_WEBSOCK_OPCODE_PONG,
858                                        &iov, 1, iov.iov_len);
859             ioc->pong_remain = ioc->encoutput.offset;
860         }
861     }   /* pong frames are ignored */
862 
863     if (payload_len) {
864         buffer_advance(&ioc->encinput, payload_len);
865     }
866     return 0;
867 }
868 
869 
870 QIOChannelWebsock *
871 qio_channel_websock_new_server(QIOChannel *master)
872 {
873     QIOChannelWebsock *wioc;
874     QIOChannel *ioc;
875 
876     wioc = QIO_CHANNEL_WEBSOCK(object_new(TYPE_QIO_CHANNEL_WEBSOCK));
877     ioc = QIO_CHANNEL(wioc);
878 
879     wioc->master = master;
880     if (qio_channel_has_feature(master, QIO_CHANNEL_FEATURE_SHUTDOWN)) {
881         qio_channel_set_feature(ioc, QIO_CHANNEL_FEATURE_SHUTDOWN);
882     }
883     object_ref(OBJECT(master));
884 
885     trace_qio_channel_websock_new_server(wioc, master);
886     return wioc;
887 }
888 
889 void qio_channel_websock_handshake(QIOChannelWebsock *ioc,
890                                    QIOTaskFunc func,
891                                    gpointer opaque,
892                                    GDestroyNotify destroy)
893 {
894     QIOTask *task;
895 
896     task = qio_task_new(OBJECT(ioc),
897                         func,
898                         opaque,
899                         destroy);
900 
901     trace_qio_channel_websock_handshake_start(ioc);
902     trace_qio_channel_websock_handshake_pending(ioc, G_IO_IN);
903     qio_channel_add_watch(ioc->master,
904                           G_IO_IN,
905                           qio_channel_websock_handshake_io,
906                           task,
907                           NULL);
908 }
909 
910 
911 static void qio_channel_websock_finalize(Object *obj)
912 {
913     QIOChannelWebsock *ioc = QIO_CHANNEL_WEBSOCK(obj);
914 
915     buffer_free(&ioc->encinput);
916     buffer_free(&ioc->encoutput);
917     buffer_free(&ioc->rawinput);
918     object_unref(OBJECT(ioc->master));
919     if (ioc->io_tag) {
920         g_source_remove(ioc->io_tag);
921     }
922     if (ioc->io_err) {
923         error_free(ioc->io_err);
924     }
925 }
926 
927 
928 static ssize_t qio_channel_websock_read_wire(QIOChannelWebsock *ioc,
929                                              Error **errp)
930 {
931     ssize_t ret;
932 
933     if (ioc->encinput.offset < 4096) {
934         size_t want = 4096 - ioc->encinput.offset;
935 
936         buffer_reserve(&ioc->encinput, want);
937         ret = qio_channel_read(ioc->master,
938                                (char *)ioc->encinput.buffer +
939                                ioc->encinput.offset,
940                                want,
941                                errp);
942         if (ret < 0) {
943             return ret;
944         }
945         if (ret == 0 && ioc->encinput.offset == 0) {
946             ioc->io_eof = TRUE;
947             return 0;
948         }
949         ioc->encinput.offset += ret;
950     }
951 
952     while (ioc->encinput.offset != 0) {
953         if (ioc->payload_remain == 0) {
954             ret = qio_channel_websock_decode_header(ioc, errp);
955             if (ret < 0) {
956                 return ret;
957             }
958         }
959 
960         ret = qio_channel_websock_decode_payload(ioc, errp);
961         if (ret < 0) {
962             return ret;
963         }
964     }
965     return 1;
966 }
967 
968 
969 static ssize_t qio_channel_websock_write_wire(QIOChannelWebsock *ioc,
970                                               Error **errp)
971 {
972     ssize_t ret;
973     ssize_t done = 0;
974 
975     while (ioc->encoutput.offset > 0) {
976         ret = qio_channel_write(ioc->master,
977                                 (char *)ioc->encoutput.buffer,
978                                 ioc->encoutput.offset,
979                                 errp);
980         if (ret < 0) {
981             if (ret == QIO_CHANNEL_ERR_BLOCK &&
982                 done > 0) {
983                 return done;
984             } else {
985                 return ret;
986             }
987         }
988         buffer_advance(&ioc->encoutput, ret);
989         done += ret;
990         if (ioc->pong_remain < ret) {
991             ioc->pong_remain = 0;
992         } else {
993             ioc->pong_remain -= ret;
994         }
995     }
996     return done;
997 }
998 
999 
1000 static void qio_channel_websock_flush_free(gpointer user_data)
1001 {
1002     QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(user_data);
1003     object_unref(OBJECT(wioc));
1004 }
1005 
1006 static void qio_channel_websock_set_watch(QIOChannelWebsock *ioc);
1007 
1008 static gboolean qio_channel_websock_flush(QIOChannel *ioc,
1009                                           GIOCondition condition,
1010                                           gpointer user_data)
1011 {
1012     QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(user_data);
1013     ssize_t ret;
1014 
1015     if (condition & G_IO_OUT) {
1016         ret = qio_channel_websock_write_wire(wioc, &wioc->io_err);
1017         if (ret < 0) {
1018             goto cleanup;
1019         }
1020     }
1021 
1022     if (condition & G_IO_IN) {
1023         ret = qio_channel_websock_read_wire(wioc, &wioc->io_err);
1024         if (ret < 0) {
1025             goto cleanup;
1026         }
1027     }
1028 
1029  cleanup:
1030     qio_channel_websock_set_watch(wioc);
1031     return FALSE;
1032 }
1033 
1034 
1035 static void qio_channel_websock_unset_watch(QIOChannelWebsock *ioc)
1036 {
1037     if (ioc->io_tag) {
1038         g_source_remove(ioc->io_tag);
1039         ioc->io_tag = 0;
1040     }
1041 }
1042 
1043 static void qio_channel_websock_set_watch(QIOChannelWebsock *ioc)
1044 {
1045     GIOCondition cond = 0;
1046 
1047     qio_channel_websock_unset_watch(ioc);
1048 
1049     if (ioc->io_err) {
1050         return;
1051     }
1052 
1053     if (ioc->encoutput.offset) {
1054         cond |= G_IO_OUT;
1055     }
1056     if (ioc->encinput.offset < QIO_CHANNEL_WEBSOCK_MAX_BUFFER &&
1057         !ioc->io_eof) {
1058         cond |= G_IO_IN;
1059     }
1060 
1061     if (cond) {
1062         object_ref(OBJECT(ioc));
1063         ioc->io_tag =
1064             qio_channel_add_watch(ioc->master,
1065                                   cond,
1066                                   qio_channel_websock_flush,
1067                                   ioc,
1068                                   qio_channel_websock_flush_free);
1069     }
1070 }
1071 
1072 
1073 static ssize_t qio_channel_websock_readv(QIOChannel *ioc,
1074                                          const struct iovec *iov,
1075                                          size_t niov,
1076                                          int **fds,
1077                                          size_t *nfds,
1078                                          Error **errp)
1079 {
1080     QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(ioc);
1081     size_t i;
1082     ssize_t got = 0;
1083     ssize_t ret;
1084 
1085     if (wioc->io_err) {
1086         error_propagate(errp, error_copy(wioc->io_err));
1087         return -1;
1088     }
1089 
1090     if (!wioc->rawinput.offset) {
1091         ret = qio_channel_websock_read_wire(QIO_CHANNEL_WEBSOCK(ioc), errp);
1092         if (ret < 0) {
1093             return ret;
1094         }
1095     }
1096 
1097     for (i = 0 ; i < niov ; i++) {
1098         size_t want = iov[i].iov_len;
1099         if (want > (wioc->rawinput.offset - got)) {
1100             want = (wioc->rawinput.offset - got);
1101         }
1102 
1103         memcpy(iov[i].iov_base,
1104                wioc->rawinput.buffer + got,
1105                want);
1106         got += want;
1107 
1108         if (want < iov[i].iov_len) {
1109             break;
1110         }
1111     }
1112 
1113     buffer_advance(&wioc->rawinput, got);
1114     qio_channel_websock_set_watch(wioc);
1115     return got;
1116 }
1117 
1118 
1119 static ssize_t qio_channel_websock_writev(QIOChannel *ioc,
1120                                           const struct iovec *iov,
1121                                           size_t niov,
1122                                           int *fds,
1123                                           size_t nfds,
1124                                           Error **errp)
1125 {
1126     QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(ioc);
1127     ssize_t want = iov_size(iov, niov);
1128     ssize_t avail;
1129     ssize_t ret;
1130 
1131     if (wioc->io_err) {
1132         error_propagate(errp, error_copy(wioc->io_err));
1133         return -1;
1134     }
1135 
1136     if (wioc->io_eof) {
1137         error_setg(errp, "%s", "Broken pipe");
1138         return -1;
1139     }
1140 
1141     avail = wioc->encoutput.offset >= QIO_CHANNEL_WEBSOCK_MAX_BUFFER ?
1142         0 : (QIO_CHANNEL_WEBSOCK_MAX_BUFFER - wioc->encoutput.offset);
1143     if (want > avail) {
1144         want = avail;
1145     }
1146 
1147     if (want) {
1148         qio_channel_websock_encode(wioc,
1149                                    QIO_CHANNEL_WEBSOCK_OPCODE_BINARY_FRAME,
1150                                    iov, niov, want);
1151     }
1152 
1153     /* Even if want == 0, we'll try write_wire in case there's
1154      * pending data we could usefully flush out
1155      */
1156     ret = qio_channel_websock_write_wire(wioc, errp);
1157     if (ret < 0 &&
1158         ret != QIO_CHANNEL_ERR_BLOCK) {
1159         qio_channel_websock_unset_watch(wioc);
1160         return -1;
1161     }
1162 
1163     qio_channel_websock_set_watch(wioc);
1164 
1165     if (want == 0) {
1166         return QIO_CHANNEL_ERR_BLOCK;
1167     }
1168 
1169     return want;
1170 }
1171 
1172 static int qio_channel_websock_set_blocking(QIOChannel *ioc,
1173                                             bool enabled,
1174                                             Error **errp)
1175 {
1176     QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(ioc);
1177 
1178     qio_channel_set_blocking(wioc->master, enabled, errp);
1179     return 0;
1180 }
1181 
1182 static void qio_channel_websock_set_delay(QIOChannel *ioc,
1183                                           bool enabled)
1184 {
1185     QIOChannelWebsock *tioc = QIO_CHANNEL_WEBSOCK(ioc);
1186 
1187     qio_channel_set_delay(tioc->master, enabled);
1188 }
1189 
1190 static void qio_channel_websock_set_cork(QIOChannel *ioc,
1191                                          bool enabled)
1192 {
1193     QIOChannelWebsock *tioc = QIO_CHANNEL_WEBSOCK(ioc);
1194 
1195     qio_channel_set_cork(tioc->master, enabled);
1196 }
1197 
1198 static int qio_channel_websock_shutdown(QIOChannel *ioc,
1199                                         QIOChannelShutdown how,
1200                                         Error **errp)
1201 {
1202     QIOChannelWebsock *tioc = QIO_CHANNEL_WEBSOCK(ioc);
1203 
1204     return qio_channel_shutdown(tioc->master, how, errp);
1205 }
1206 
1207 static int qio_channel_websock_close(QIOChannel *ioc,
1208                                      Error **errp)
1209 {
1210     QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(ioc);
1211 
1212     trace_qio_channel_websock_close(ioc);
1213     return qio_channel_close(wioc->master, errp);
1214 }
1215 
1216 typedef struct QIOChannelWebsockSource QIOChannelWebsockSource;
1217 struct QIOChannelWebsockSource {
1218     GSource parent;
1219     QIOChannelWebsock *wioc;
1220     GIOCondition condition;
1221 };
1222 
1223 static gboolean
1224 qio_channel_websock_source_check(GSource *source)
1225 {
1226     QIOChannelWebsockSource *wsource = (QIOChannelWebsockSource *)source;
1227     GIOCondition cond = 0;
1228 
1229     if (wsource->wioc->rawinput.offset || wsource->wioc->io_eof) {
1230         cond |= G_IO_IN;
1231     }
1232     if (wsource->wioc->encoutput.offset < QIO_CHANNEL_WEBSOCK_MAX_BUFFER) {
1233         cond |= G_IO_OUT;
1234     }
1235 
1236     return cond & wsource->condition;
1237 }
1238 
1239 static gboolean
1240 qio_channel_websock_source_prepare(GSource *source,
1241                                    gint *timeout)
1242 {
1243     *timeout = -1;
1244     return qio_channel_websock_source_check(source);
1245 }
1246 
1247 static gboolean
1248 qio_channel_websock_source_dispatch(GSource *source,
1249                                     GSourceFunc callback,
1250                                     gpointer user_data)
1251 {
1252     QIOChannelFunc func = (QIOChannelFunc)callback;
1253     QIOChannelWebsockSource *wsource = (QIOChannelWebsockSource *)source;
1254 
1255     return (*func)(QIO_CHANNEL(wsource->wioc),
1256                    qio_channel_websock_source_check(source),
1257                    user_data);
1258 }
1259 
1260 static void
1261 qio_channel_websock_source_finalize(GSource *source)
1262 {
1263     QIOChannelWebsockSource *ssource = (QIOChannelWebsockSource *)source;
1264 
1265     object_unref(OBJECT(ssource->wioc));
1266 }
1267 
1268 GSourceFuncs qio_channel_websock_source_funcs = {
1269     qio_channel_websock_source_prepare,
1270     qio_channel_websock_source_check,
1271     qio_channel_websock_source_dispatch,
1272     qio_channel_websock_source_finalize
1273 };
1274 
1275 static GSource *qio_channel_websock_create_watch(QIOChannel *ioc,
1276                                                  GIOCondition condition)
1277 {
1278     QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(ioc);
1279     QIOChannelWebsockSource *ssource;
1280     GSource *source;
1281 
1282     source = g_source_new(&qio_channel_websock_source_funcs,
1283                           sizeof(QIOChannelWebsockSource));
1284     ssource = (QIOChannelWebsockSource *)source;
1285 
1286     ssource->wioc = wioc;
1287     object_ref(OBJECT(wioc));
1288 
1289     ssource->condition = condition;
1290 
1291     qio_channel_websock_set_watch(wioc);
1292     return source;
1293 }
1294 
1295 static void qio_channel_websock_class_init(ObjectClass *klass,
1296                                            void *class_data G_GNUC_UNUSED)
1297 {
1298     QIOChannelClass *ioc_klass = QIO_CHANNEL_CLASS(klass);
1299 
1300     ioc_klass->io_writev = qio_channel_websock_writev;
1301     ioc_klass->io_readv = qio_channel_websock_readv;
1302     ioc_klass->io_set_blocking = qio_channel_websock_set_blocking;
1303     ioc_klass->io_set_cork = qio_channel_websock_set_cork;
1304     ioc_klass->io_set_delay = qio_channel_websock_set_delay;
1305     ioc_klass->io_close = qio_channel_websock_close;
1306     ioc_klass->io_shutdown = qio_channel_websock_shutdown;
1307     ioc_klass->io_create_watch = qio_channel_websock_create_watch;
1308 }
1309 
1310 static const TypeInfo qio_channel_websock_info = {
1311     .parent = TYPE_QIO_CHANNEL,
1312     .name = TYPE_QIO_CHANNEL_WEBSOCK,
1313     .instance_size = sizeof(QIOChannelWebsock),
1314     .instance_finalize = qio_channel_websock_finalize,
1315     .class_init = qio_channel_websock_class_init,
1316 };
1317 
1318 static void qio_channel_websock_register_types(void)
1319 {
1320     type_register_static(&qio_channel_websock_info);
1321 }
1322 
1323 type_init(qio_channel_websock_register_types);
1324