1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include "qemu/osdep.h"
22#include "qapi/error.h"
23#include "io/channel-websock.h"
24#include "crypto/hash.h"
25#include "trace.h"
26
27
28
29#define QIO_CHANNEL_WEBSOCK_MAX_BUFFER 8192
30
31#define QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN 24
32#define QIO_CHANNEL_WEBSOCK_GUID "258EAFA5-E914-47DA-95CA-C5AB0DC85B11"
33#define QIO_CHANNEL_WEBSOCK_GUID_LEN strlen(QIO_CHANNEL_WEBSOCK_GUID)
34
35#define QIO_CHANNEL_WEBSOCK_HEADER_PROTOCOL "Sec-WebSocket-Protocol"
36#define QIO_CHANNEL_WEBSOCK_HEADER_VERSION "Sec-WebSocket-Version"
37#define QIO_CHANNEL_WEBSOCK_HEADER_KEY "Sec-WebSocket-Key"
38
39#define QIO_CHANNEL_WEBSOCK_PROTOCOL_BINARY "binary"
40
41#define QIO_CHANNEL_WEBSOCK_HANDSHAKE_RESPONSE \
42 "HTTP/1.1 101 Switching Protocols\r\n" \
43 "Upgrade: websocket\r\n" \
44 "Connection: Upgrade\r\n" \
45 "Sec-WebSocket-Accept: %s\r\n" \
46 "Sec-WebSocket-Protocol: binary\r\n" \
47 "\r\n"
48#define QIO_CHANNEL_WEBSOCK_HANDSHAKE_DELIM "\r\n"
49#define QIO_CHANNEL_WEBSOCK_HANDSHAKE_END "\r\n\r\n"
50#define QIO_CHANNEL_WEBSOCK_SUPPORTED_VERSION "13"
51
52
53
54
55
56#define QIO_CHANNEL_WEBSOCK_HEADER_LEN_7_BIT 6
57
58#define QIO_CHANNEL_WEBSOCK_HEADER_LEN_16_BIT 8
59
60#define QIO_CHANNEL_WEBSOCK_HEADER_LEN_64_BIT 14
61
62
63#define QIO_CHANNEL_WEBSOCK_HEADER_LEN_MASK 4
64
65
66#define QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_THRESHOLD_7_BIT 126
67
68#define QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_THRESHOLD_16_BIT 65536
69
70
71#define QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_16_BIT 126
72
73#define QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_64_BIT 127
74
75
76#define QIO_CHANNEL_WEBSOCK_HEADER_FIELD_FIN 0x80
77#define QIO_CHANNEL_WEBSOCK_HEADER_FIELD_OPCODE 0x0f
78#define QIO_CHANNEL_WEBSOCK_HEADER_FIELD_HAS_MASK 0x80
79#define QIO_CHANNEL_WEBSOCK_HEADER_FIELD_PAYLOAD_LEN 0x7f
80#define QIO_CHANNEL_WEBSOCK_HEADER_SHIFT_FIN 7
81#define QIO_CHANNEL_WEBSOCK_HEADER_SHIFT_HAS_MASK 7
82
83typedef struct QIOChannelWebsockHeader QIOChannelWebsockHeader;
84
85struct QEMU_PACKED QIOChannelWebsockHeader {
86 unsigned char b0;
87 unsigned char b1;
88 union {
89 struct QEMU_PACKED {
90 uint16_t l16;
91 QIOChannelWebsockMask m16;
92 } s16;
93 struct QEMU_PACKED {
94 uint64_t l64;
95 QIOChannelWebsockMask m64;
96 } s64;
97 QIOChannelWebsockMask m;
98 } u;
99};
100
101enum {
102 QIO_CHANNEL_WEBSOCK_OPCODE_CONTINUATION = 0x0,
103 QIO_CHANNEL_WEBSOCK_OPCODE_TEXT_FRAME = 0x1,
104 QIO_CHANNEL_WEBSOCK_OPCODE_BINARY_FRAME = 0x2,
105 QIO_CHANNEL_WEBSOCK_OPCODE_CLOSE = 0x8,
106 QIO_CHANNEL_WEBSOCK_OPCODE_PING = 0x9,
107 QIO_CHANNEL_WEBSOCK_OPCODE_PONG = 0xA
108};
109
110static char *qio_channel_websock_handshake_entry(const char *handshake,
111 size_t handshake_len,
112 const char *name)
113{
114 char *begin, *end, *ret = NULL;
115 char *line = g_strdup_printf("%s%s: ",
116 QIO_CHANNEL_WEBSOCK_HANDSHAKE_DELIM,
117 name);
118 begin = g_strstr_len(handshake, handshake_len, line);
119 if (begin != NULL) {
120 begin += strlen(line);
121 end = g_strstr_len(begin, handshake_len - (begin - handshake),
122 QIO_CHANNEL_WEBSOCK_HANDSHAKE_DELIM);
123 if (end != NULL) {
124 ret = g_strndup(begin, end - begin);
125 }
126 }
127 g_free(line);
128 return ret;
129}
130
131
132static int qio_channel_websock_handshake_send_response(QIOChannelWebsock *ioc,
133 const char *key,
134 Error **errp)
135{
136 char combined_key[QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN +
137 QIO_CHANNEL_WEBSOCK_GUID_LEN + 1];
138 char *accept = NULL, *response = NULL;
139 size_t responselen;
140
141 g_strlcpy(combined_key, key, QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN + 1);
142 g_strlcat(combined_key, QIO_CHANNEL_WEBSOCK_GUID,
143 QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN +
144 QIO_CHANNEL_WEBSOCK_GUID_LEN + 1);
145
146
147 if (qcrypto_hash_base64(QCRYPTO_HASH_ALG_SHA1,
148 combined_key,
149 QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN +
150 QIO_CHANNEL_WEBSOCK_GUID_LEN,
151 &accept,
152 errp) < 0) {
153 return -1;
154 }
155
156 response = g_strdup_printf(QIO_CHANNEL_WEBSOCK_HANDSHAKE_RESPONSE, accept);
157 responselen = strlen(response);
158 buffer_reserve(&ioc->encoutput, responselen);
159 buffer_append(&ioc->encoutput, response, responselen);
160
161 g_free(accept);
162 g_free(response);
163
164 return 0;
165}
166
167static int qio_channel_websock_handshake_process(QIOChannelWebsock *ioc,
168 const char *line,
169 size_t size,
170 Error **errp)
171{
172 int ret = -1;
173 char *protocols = qio_channel_websock_handshake_entry(
174 line, size, QIO_CHANNEL_WEBSOCK_HEADER_PROTOCOL);
175 char *version = qio_channel_websock_handshake_entry(
176 line, size, QIO_CHANNEL_WEBSOCK_HEADER_VERSION);
177 char *key = qio_channel_websock_handshake_entry(
178 line, size, QIO_CHANNEL_WEBSOCK_HEADER_KEY);
179
180 if (!protocols) {
181 error_setg(errp, "Missing websocket protocol header data");
182 goto cleanup;
183 }
184
185 if (!version) {
186 error_setg(errp, "Missing websocket version header data");
187 goto cleanup;
188 }
189
190 if (!key) {
191 error_setg(errp, "Missing websocket key header data");
192 goto cleanup;
193 }
194
195 if (!g_strrstr(protocols, QIO_CHANNEL_WEBSOCK_PROTOCOL_BINARY)) {
196 error_setg(errp, "No '%s' protocol is supported by client '%s'",
197 QIO_CHANNEL_WEBSOCK_PROTOCOL_BINARY, protocols);
198 goto cleanup;
199 }
200
201 if (!g_str_equal(version, QIO_CHANNEL_WEBSOCK_SUPPORTED_VERSION)) {
202 error_setg(errp, "Version '%s' is not supported by client '%s'",
203 QIO_CHANNEL_WEBSOCK_SUPPORTED_VERSION, version);
204 goto cleanup;
205 }
206
207 if (strlen(key) != QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN) {
208 error_setg(errp, "Key length '%zu' was not as expected '%d'",
209 strlen(key), QIO_CHANNEL_WEBSOCK_CLIENT_KEY_LEN);
210 goto cleanup;
211 }
212
213 ret = qio_channel_websock_handshake_send_response(ioc, key, errp);
214
215 cleanup:
216 g_free(protocols);
217 g_free(version);
218 g_free(key);
219 return ret;
220}
221
222static int qio_channel_websock_handshake_read(QIOChannelWebsock *ioc,
223 Error **errp)
224{
225 char *handshake_end;
226 ssize_t ret;
227
228
229 size_t want = 4096 - ioc->encinput.offset;
230 buffer_reserve(&ioc->encinput, want);
231 ret = qio_channel_read(ioc->master,
232 (char *)buffer_end(&ioc->encinput), want, errp);
233 if (ret < 0) {
234 return -1;
235 }
236 ioc->encinput.offset += ret;
237
238 handshake_end = g_strstr_len((char *)ioc->encinput.buffer,
239 ioc->encinput.offset,
240 QIO_CHANNEL_WEBSOCK_HANDSHAKE_END);
241 if (!handshake_end) {
242 if (ioc->encinput.offset >= 4096) {
243 error_setg(errp,
244 "End of headers not found in first 4096 bytes");
245 return -1;
246 } else {
247 return 0;
248 }
249 }
250
251 if (qio_channel_websock_handshake_process(ioc,
252 (char *)ioc->encinput.buffer,
253 ioc->encinput.offset,
254 errp) < 0) {
255 return -1;
256 }
257
258 buffer_advance(&ioc->encinput,
259 handshake_end - (char *)ioc->encinput.buffer +
260 strlen(QIO_CHANNEL_WEBSOCK_HANDSHAKE_END));
261 return 1;
262}
263
264static gboolean qio_channel_websock_handshake_send(QIOChannel *ioc,
265 GIOCondition condition,
266 gpointer user_data)
267{
268 QIOTask *task = user_data;
269 QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(
270 qio_task_get_source(task));
271 Error *err = NULL;
272 ssize_t ret;
273
274 ret = qio_channel_write(wioc->master,
275 (char *)wioc->encoutput.buffer,
276 wioc->encoutput.offset,
277 &err);
278
279 if (ret < 0) {
280 trace_qio_channel_websock_handshake_fail(ioc);
281 qio_task_abort(task, err);
282 error_free(err);
283 return FALSE;
284 }
285
286 buffer_advance(&wioc->encoutput, ret);
287 if (wioc->encoutput.offset == 0) {
288 trace_qio_channel_websock_handshake_complete(ioc);
289 qio_task_complete(task);
290 return FALSE;
291 }
292 trace_qio_channel_websock_handshake_pending(ioc, G_IO_OUT);
293 return TRUE;
294}
295
296static gboolean qio_channel_websock_handshake_io(QIOChannel *ioc,
297 GIOCondition condition,
298 gpointer user_data)
299{
300 QIOTask *task = user_data;
301 QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(
302 qio_task_get_source(task));
303 Error *err = NULL;
304 int ret;
305
306 ret = qio_channel_websock_handshake_read(wioc, &err);
307 if (ret < 0) {
308 trace_qio_channel_websock_handshake_fail(ioc);
309 qio_task_abort(task, err);
310 error_free(err);
311 return FALSE;
312 }
313 if (ret == 0) {
314 trace_qio_channel_websock_handshake_pending(ioc, G_IO_IN);
315
316 return TRUE;
317 }
318
319 trace_qio_channel_websock_handshake_reply(ioc);
320 qio_channel_add_watch(
321 wioc->master,
322 G_IO_OUT,
323 qio_channel_websock_handshake_send,
324 task,
325 NULL);
326 return FALSE;
327}
328
329
330static void qio_channel_websock_encode(QIOChannelWebsock *ioc)
331{
332 size_t header_size;
333 union {
334 char buf[QIO_CHANNEL_WEBSOCK_HEADER_LEN_64_BIT];
335 QIOChannelWebsockHeader ws;
336 } header;
337
338 if (!ioc->rawoutput.offset) {
339 return;
340 }
341
342 header.ws.b0 = (1 << QIO_CHANNEL_WEBSOCK_HEADER_SHIFT_FIN) |
343 (QIO_CHANNEL_WEBSOCK_OPCODE_BINARY_FRAME &
344 QIO_CHANNEL_WEBSOCK_HEADER_FIELD_OPCODE);
345 if (ioc->rawoutput.offset <
346 QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_THRESHOLD_7_BIT) {
347 header.ws.b1 = (uint8_t)ioc->rawoutput.offset;
348 header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_7_BIT;
349 } else if (ioc->rawoutput.offset <
350 QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_THRESHOLD_16_BIT) {
351 header.ws.b1 = QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_16_BIT;
352 header.ws.u.s16.l16 = cpu_to_be16((uint16_t)ioc->rawoutput.offset);
353 header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_16_BIT;
354 } else {
355 header.ws.b1 = QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_64_BIT;
356 header.ws.u.s64.l64 = cpu_to_be64(ioc->rawoutput.offset);
357 header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_64_BIT;
358 }
359 header_size -= QIO_CHANNEL_WEBSOCK_HEADER_LEN_MASK;
360
361 buffer_reserve(&ioc->encoutput, header_size + ioc->rawoutput.offset);
362 buffer_append(&ioc->encoutput, header.buf, header_size);
363 buffer_append(&ioc->encoutput, ioc->rawoutput.buffer,
364 ioc->rawoutput.offset);
365 buffer_reset(&ioc->rawoutput);
366}
367
368
369static ssize_t qio_channel_websock_decode_header(QIOChannelWebsock *ioc,
370 Error **errp)
371{
372 unsigned char opcode, fin, has_mask;
373 size_t header_size;
374 size_t payload_len;
375 QIOChannelWebsockHeader *header =
376 (QIOChannelWebsockHeader *)ioc->encinput.buffer;
377
378 if (ioc->payload_remain) {
379 error_setg(errp,
380 "Decoding header but %zu bytes of payload remain",
381 ioc->payload_remain);
382 return -1;
383 }
384 if (ioc->encinput.offset < QIO_CHANNEL_WEBSOCK_HEADER_LEN_7_BIT) {
385
386 return QIO_CHANNEL_ERR_BLOCK;
387 }
388
389 fin = (header->b0 & QIO_CHANNEL_WEBSOCK_HEADER_FIELD_FIN) >>
390 QIO_CHANNEL_WEBSOCK_HEADER_SHIFT_FIN;
391 opcode = header->b0 & QIO_CHANNEL_WEBSOCK_HEADER_FIELD_OPCODE;
392 has_mask = (header->b1 & QIO_CHANNEL_WEBSOCK_HEADER_FIELD_HAS_MASK) >>
393 QIO_CHANNEL_WEBSOCK_HEADER_SHIFT_HAS_MASK;
394 payload_len = header->b1 & QIO_CHANNEL_WEBSOCK_HEADER_FIELD_PAYLOAD_LEN;
395
396 if (opcode == QIO_CHANNEL_WEBSOCK_OPCODE_CLOSE) {
397
398 return 0;
399 }
400
401
402
403
404
405
406 if (!fin) {
407 error_setg(errp, "websocket fragmentation is not supported");
408 return -1;
409 }
410 if (!has_mask) {
411 error_setg(errp, "websocket frames must be masked");
412 return -1;
413 }
414 if (opcode != QIO_CHANNEL_WEBSOCK_OPCODE_BINARY_FRAME) {
415 error_setg(errp, "only binary websocket frames are supported");
416 return -1;
417 }
418
419 if (payload_len < QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_16_BIT) {
420 ioc->payload_remain = payload_len;
421 header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_7_BIT;
422 ioc->mask = header->u.m;
423 } else if (payload_len == QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_16_BIT &&
424 ioc->encinput.offset >= QIO_CHANNEL_WEBSOCK_HEADER_LEN_16_BIT) {
425 ioc->payload_remain = be16_to_cpu(header->u.s16.l16);
426 header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_16_BIT;
427 ioc->mask = header->u.s16.m16;
428 } else if (payload_len == QIO_CHANNEL_WEBSOCK_PAYLOAD_LEN_MAGIC_64_BIT &&
429 ioc->encinput.offset >= QIO_CHANNEL_WEBSOCK_HEADER_LEN_64_BIT) {
430 ioc->payload_remain = be64_to_cpu(header->u.s64.l64);
431 header_size = QIO_CHANNEL_WEBSOCK_HEADER_LEN_64_BIT;
432 ioc->mask = header->u.s64.m64;
433 } else {
434
435 return QIO_CHANNEL_ERR_BLOCK;
436 }
437
438 buffer_advance(&ioc->encinput, header_size);
439 return 1;
440}
441
442
443static ssize_t qio_channel_websock_decode_payload(QIOChannelWebsock *ioc,
444 Error **errp)
445{
446 size_t i;
447 size_t payload_len;
448 uint32_t *payload32;
449
450 if (!ioc->payload_remain) {
451 error_setg(errp,
452 "Decoding payload but no bytes of payload remain");
453 return -1;
454 }
455
456
457
458
459
460 if (ioc->encinput.offset < ioc->payload_remain) {
461 payload_len = ioc->encinput.offset - (ioc->encinput.offset % 4);
462 } else {
463 payload_len = ioc->payload_remain;
464 }
465 if (payload_len == 0) {
466 return QIO_CHANNEL_ERR_BLOCK;
467 }
468
469 ioc->payload_remain -= payload_len;
470
471
472
473 payload32 = (uint32_t *)ioc->encinput.buffer;
474 for (i = 0; i < payload_len / 4; i++) {
475 payload32[i] ^= ioc->mask.u;
476 }
477
478 for (i *= 4; i < payload_len; i++) {
479 ioc->encinput.buffer[i] ^= ioc->mask.c[i % 4];
480 }
481
482 buffer_reserve(&ioc->rawinput, payload_len);
483 buffer_append(&ioc->rawinput, ioc->encinput.buffer, payload_len);
484 buffer_advance(&ioc->encinput, payload_len);
485 return payload_len;
486}
487
488
489QIOChannelWebsock *
490qio_channel_websock_new_server(QIOChannel *master)
491{
492 QIOChannelWebsock *wioc;
493 QIOChannel *ioc;
494
495 wioc = QIO_CHANNEL_WEBSOCK(object_new(TYPE_QIO_CHANNEL_WEBSOCK));
496 ioc = QIO_CHANNEL(wioc);
497
498 wioc->master = master;
499 if (master->features & (1 << QIO_CHANNEL_FEATURE_SHUTDOWN)) {
500 ioc->features |= (1 << QIO_CHANNEL_FEATURE_SHUTDOWN);
501 }
502 object_ref(OBJECT(master));
503
504 trace_qio_channel_websock_new_server(wioc, master);
505 return wioc;
506}
507
508void qio_channel_websock_handshake(QIOChannelWebsock *ioc,
509 QIOTaskFunc func,
510 gpointer opaque,
511 GDestroyNotify destroy)
512{
513 QIOTask *task;
514
515 task = qio_task_new(OBJECT(ioc),
516 func,
517 opaque,
518 destroy);
519
520 trace_qio_channel_websock_handshake_start(ioc);
521 trace_qio_channel_websock_handshake_pending(ioc, G_IO_IN);
522 qio_channel_add_watch(ioc->master,
523 G_IO_IN,
524 qio_channel_websock_handshake_io,
525 task,
526 NULL);
527}
528
529
530static void qio_channel_websock_finalize(Object *obj)
531{
532 QIOChannelWebsock *ioc = QIO_CHANNEL_WEBSOCK(obj);
533
534 buffer_free(&ioc->encinput);
535 buffer_free(&ioc->encoutput);
536 buffer_free(&ioc->rawinput);
537 buffer_free(&ioc->rawoutput);
538 object_unref(OBJECT(ioc->master));
539 if (ioc->io_tag) {
540 g_source_remove(ioc->io_tag);
541 }
542 if (ioc->io_err) {
543 error_free(ioc->io_err);
544 }
545}
546
547
548static ssize_t qio_channel_websock_read_wire(QIOChannelWebsock *ioc,
549 Error **errp)
550{
551 ssize_t ret;
552
553 if (ioc->encinput.offset < 4096) {
554 size_t want = 4096 - ioc->encinput.offset;
555
556 buffer_reserve(&ioc->encinput, want);
557 ret = qio_channel_read(ioc->master,
558 (char *)ioc->encinput.buffer +
559 ioc->encinput.offset,
560 want,
561 errp);
562 if (ret < 0) {
563 return ret;
564 }
565 if (ret == 0 &&
566 ioc->encinput.offset == 0) {
567 return 0;
568 }
569 ioc->encinput.offset += ret;
570 }
571
572 if (ioc->payload_remain == 0) {
573 ret = qio_channel_websock_decode_header(ioc, errp);
574 if (ret < 0) {
575 return ret;
576 }
577 if (ret == 0) {
578 return 0;
579 }
580 }
581
582 ret = qio_channel_websock_decode_payload(ioc, errp);
583 if (ret < 0) {
584 return ret;
585 }
586 return ret;
587}
588
589
590static ssize_t qio_channel_websock_write_wire(QIOChannelWebsock *ioc,
591 Error **errp)
592{
593 ssize_t ret;
594 ssize_t done = 0;
595 qio_channel_websock_encode(ioc);
596
597 while (ioc->encoutput.offset > 0) {
598 ret = qio_channel_write(ioc->master,
599 (char *)ioc->encoutput.buffer,
600 ioc->encoutput.offset,
601 errp);
602 if (ret < 0) {
603 if (ret == QIO_CHANNEL_ERR_BLOCK &&
604 done > 0) {
605 return done;
606 } else {
607 return ret;
608 }
609 }
610 buffer_advance(&ioc->encoutput, ret);
611 done += ret;
612 }
613 return done;
614}
615
616
617static void qio_channel_websock_flush_free(gpointer user_data)
618{
619 QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(user_data);
620 object_unref(OBJECT(wioc));
621}
622
623static void qio_channel_websock_set_watch(QIOChannelWebsock *ioc);
624
625static gboolean qio_channel_websock_flush(QIOChannel *ioc,
626 GIOCondition condition,
627 gpointer user_data)
628{
629 QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(user_data);
630 ssize_t ret;
631
632 if (condition & G_IO_OUT) {
633 ret = qio_channel_websock_write_wire(wioc, &wioc->io_err);
634 if (ret < 0) {
635 goto cleanup;
636 }
637 }
638
639 if (condition & G_IO_IN) {
640 ret = qio_channel_websock_read_wire(wioc, &wioc->io_err);
641 if (ret < 0) {
642 goto cleanup;
643 }
644 if (ret == 0) {
645 wioc->io_eof = TRUE;
646 }
647 }
648
649 cleanup:
650 qio_channel_websock_set_watch(wioc);
651 return FALSE;
652}
653
654
655static void qio_channel_websock_unset_watch(QIOChannelWebsock *ioc)
656{
657 if (ioc->io_tag) {
658 g_source_remove(ioc->io_tag);
659 ioc->io_tag = 0;
660 }
661}
662
663static void qio_channel_websock_set_watch(QIOChannelWebsock *ioc)
664{
665 GIOCondition cond = 0;
666
667 qio_channel_websock_unset_watch(ioc);
668
669 if (ioc->io_err) {
670 return;
671 }
672
673 if (ioc->encoutput.offset) {
674 cond |= G_IO_OUT;
675 }
676 if (ioc->encinput.offset < QIO_CHANNEL_WEBSOCK_MAX_BUFFER &&
677 !ioc->io_eof) {
678 cond |= G_IO_IN;
679 }
680
681 if (cond) {
682 object_ref(OBJECT(ioc));
683 ioc->io_tag =
684 qio_channel_add_watch(ioc->master,
685 cond,
686 qio_channel_websock_flush,
687 ioc,
688 qio_channel_websock_flush_free);
689 }
690}
691
692
693static ssize_t qio_channel_websock_readv(QIOChannel *ioc,
694 const struct iovec *iov,
695 size_t niov,
696 int **fds,
697 size_t *nfds,
698 Error **errp)
699{
700 QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(ioc);
701 size_t i;
702 ssize_t got = 0;
703 ssize_t ret;
704
705 if (wioc->io_err) {
706 *errp = error_copy(wioc->io_err);
707 return -1;
708 }
709
710 if (!wioc->rawinput.offset) {
711 ret = qio_channel_websock_read_wire(QIO_CHANNEL_WEBSOCK(ioc), errp);
712 if (ret < 0) {
713 return ret;
714 }
715 }
716
717 for (i = 0 ; i < niov ; i++) {
718 size_t want = iov[i].iov_len;
719 if (want > (wioc->rawinput.offset - got)) {
720 want = (wioc->rawinput.offset - got);
721 }
722
723 memcpy(iov[i].iov_base,
724 wioc->rawinput.buffer + got,
725 want);
726 got += want;
727
728 if (want < iov[i].iov_len) {
729 break;
730 }
731 }
732
733 buffer_advance(&wioc->rawinput, got);
734 qio_channel_websock_set_watch(wioc);
735 return got;
736}
737
738
739static ssize_t qio_channel_websock_writev(QIOChannel *ioc,
740 const struct iovec *iov,
741 size_t niov,
742 int *fds,
743 size_t nfds,
744 Error **errp)
745{
746 QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(ioc);
747 size_t i;
748 ssize_t done = 0;
749 ssize_t ret;
750
751 if (wioc->io_err) {
752 *errp = error_copy(wioc->io_err);
753 return -1;
754 }
755
756 if (wioc->io_eof) {
757 error_setg(errp, "%s", "Broken pipe");
758 return -1;
759 }
760
761 for (i = 0; i < niov; i++) {
762 size_t want = iov[i].iov_len;
763 if ((want + wioc->rawoutput.offset) > QIO_CHANNEL_WEBSOCK_MAX_BUFFER) {
764 want = (QIO_CHANNEL_WEBSOCK_MAX_BUFFER - wioc->rawoutput.offset);
765 }
766 if (want == 0) {
767 goto done;
768 }
769
770 buffer_reserve(&wioc->rawoutput, want);
771 buffer_append(&wioc->rawoutput, iov[i].iov_base, want);
772 done += want;
773 if (want < iov[i].iov_len) {
774 break;
775 }
776 }
777
778 done:
779 ret = qio_channel_websock_write_wire(wioc, errp);
780 if (ret < 0 &&
781 ret != QIO_CHANNEL_ERR_BLOCK) {
782 qio_channel_websock_unset_watch(wioc);
783 return -1;
784 }
785
786 qio_channel_websock_set_watch(wioc);
787
788 if (done == 0) {
789 return QIO_CHANNEL_ERR_BLOCK;
790 }
791
792 return done;
793}
794
795static int qio_channel_websock_set_blocking(QIOChannel *ioc,
796 bool enabled,
797 Error **errp)
798{
799 QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(ioc);
800
801 qio_channel_set_blocking(wioc->master, enabled, errp);
802 return 0;
803}
804
805static void qio_channel_websock_set_delay(QIOChannel *ioc,
806 bool enabled)
807{
808 QIOChannelWebsock *tioc = QIO_CHANNEL_WEBSOCK(ioc);
809
810 qio_channel_set_delay(tioc->master, enabled);
811}
812
813static void qio_channel_websock_set_cork(QIOChannel *ioc,
814 bool enabled)
815{
816 QIOChannelWebsock *tioc = QIO_CHANNEL_WEBSOCK(ioc);
817
818 qio_channel_set_cork(tioc->master, enabled);
819}
820
821static int qio_channel_websock_shutdown(QIOChannel *ioc,
822 QIOChannelShutdown how,
823 Error **errp)
824{
825 QIOChannelWebsock *tioc = QIO_CHANNEL_WEBSOCK(ioc);
826
827 return qio_channel_shutdown(tioc->master, how, errp);
828}
829
830static int qio_channel_websock_close(QIOChannel *ioc,
831 Error **errp)
832{
833 QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(ioc);
834
835 return qio_channel_close(wioc->master, errp);
836}
837
838typedef struct QIOChannelWebsockSource QIOChannelWebsockSource;
839struct QIOChannelWebsockSource {
840 GSource parent;
841 QIOChannelWebsock *wioc;
842 GIOCondition condition;
843};
844
845static gboolean
846qio_channel_websock_source_prepare(GSource *source,
847 gint *timeout)
848{
849 QIOChannelWebsockSource *wsource = (QIOChannelWebsockSource *)source;
850 GIOCondition cond = 0;
851 *timeout = -1;
852
853 if (wsource->wioc->rawinput.offset) {
854 cond |= G_IO_IN;
855 }
856 if (wsource->wioc->rawoutput.offset < QIO_CHANNEL_WEBSOCK_MAX_BUFFER) {
857 cond |= G_IO_OUT;
858 }
859
860 return cond & wsource->condition;
861}
862
863static gboolean
864qio_channel_websock_source_check(GSource *source)
865{
866 QIOChannelWebsockSource *wsource = (QIOChannelWebsockSource *)source;
867 GIOCondition cond = 0;
868
869 if (wsource->wioc->rawinput.offset) {
870 cond |= G_IO_IN;
871 }
872 if (wsource->wioc->rawoutput.offset < QIO_CHANNEL_WEBSOCK_MAX_BUFFER) {
873 cond |= G_IO_OUT;
874 }
875
876 return cond & wsource->condition;
877}
878
879static gboolean
880qio_channel_websock_source_dispatch(GSource *source,
881 GSourceFunc callback,
882 gpointer user_data)
883{
884 QIOChannelFunc func = (QIOChannelFunc)callback;
885 QIOChannelWebsockSource *wsource = (QIOChannelWebsockSource *)source;
886 GIOCondition cond = 0;
887
888 if (wsource->wioc->rawinput.offset) {
889 cond |= G_IO_IN;
890 }
891 if (wsource->wioc->rawoutput.offset < QIO_CHANNEL_WEBSOCK_MAX_BUFFER) {
892 cond |= G_IO_OUT;
893 }
894
895 return (*func)(QIO_CHANNEL(wsource->wioc),
896 (cond & wsource->condition),
897 user_data);
898}
899
900static void
901qio_channel_websock_source_finalize(GSource *source)
902{
903 QIOChannelWebsockSource *ssource = (QIOChannelWebsockSource *)source;
904
905 object_unref(OBJECT(ssource->wioc));
906}
907
908GSourceFuncs qio_channel_websock_source_funcs = {
909 qio_channel_websock_source_prepare,
910 qio_channel_websock_source_check,
911 qio_channel_websock_source_dispatch,
912 qio_channel_websock_source_finalize
913};
914
915static GSource *qio_channel_websock_create_watch(QIOChannel *ioc,
916 GIOCondition condition)
917{
918 QIOChannelWebsock *wioc = QIO_CHANNEL_WEBSOCK(ioc);
919 QIOChannelWebsockSource *ssource;
920 GSource *source;
921
922 source = g_source_new(&qio_channel_websock_source_funcs,
923 sizeof(QIOChannelWebsockSource));
924 ssource = (QIOChannelWebsockSource *)source;
925
926 ssource->wioc = wioc;
927 object_ref(OBJECT(wioc));
928
929 ssource->condition = condition;
930
931 qio_channel_websock_set_watch(wioc);
932 return source;
933}
934
935static void qio_channel_websock_class_init(ObjectClass *klass,
936 void *class_data G_GNUC_UNUSED)
937{
938 QIOChannelClass *ioc_klass = QIO_CHANNEL_CLASS(klass);
939
940 ioc_klass->io_writev = qio_channel_websock_writev;
941 ioc_klass->io_readv = qio_channel_websock_readv;
942 ioc_klass->io_set_blocking = qio_channel_websock_set_blocking;
943 ioc_klass->io_set_cork = qio_channel_websock_set_cork;
944 ioc_klass->io_set_delay = qio_channel_websock_set_delay;
945 ioc_klass->io_close = qio_channel_websock_close;
946 ioc_klass->io_shutdown = qio_channel_websock_shutdown;
947 ioc_klass->io_create_watch = qio_channel_websock_create_watch;
948}
949
950static const TypeInfo qio_channel_websock_info = {
951 .parent = TYPE_QIO_CHANNEL,
952 .name = TYPE_QIO_CHANNEL_WEBSOCK,
953 .instance_size = sizeof(QIOChannelWebsock),
954 .instance_finalize = qio_channel_websock_finalize,
955 .class_init = qio_channel_websock_class_init,
956};
957
958static void qio_channel_websock_register_types(void)
959{
960 type_register_static(&qio_channel_websock_info);
961}
962
963type_init(qio_channel_websock_register_types);
964