]> git.proxmox.com Git - mirror_qemu.git/blame - qemu-char.c
projects / mirror_qemu.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
qemu-char: convert pipe backend to data-driven creation
[mirror_qemu.git] / qemu-char.c
CommitLineData
6f97dba0
AL		 1/*
2 * QEMU System Emulator
3 *
4 * Copyright (c) 2003-2008 Fabrice Bellard
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
12 *
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
15 *
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22 * THE SOFTWARE.
23 */
24#include "qemu-common.h"
83c9089e 25#include "monitor/monitor.h"
9c17d615 26#include "sysemu/sysemu.h"
d49b6836 27#include "qemu/error-report.h"
1de7afc9 28#include "qemu/timer.h"
dccfcd0e 29#include "sysemu/char.h"
cf3ebac7 30#include "hw/usb.h"
c5a415a0 31#include "qmp-commands.h"
cfb429cb
CM		 32#include "qapi/qmp-input-visitor.h"
33#include "qapi/qmp-output-visitor.h"
34#include "qapi-visit.h"
6f97dba0
AL		 35
36#include <unistd.h>
37#include <fcntl.h>
6f97dba0
AL		 38#include <time.h>
39#include <errno.h>
40#include <sys/time.h>
41#include <zlib.h>
42
43#ifndef _WIN32
44#include <sys/times.h>
45#include <sys/wait.h>
46#include <termios.h>
47#include <sys/mman.h>
48#include <sys/ioctl.h>
24646c7e 49#include <sys/resource.h>
6f97dba0
AL		 50#include <sys/socket.h>
51#include <netinet/in.h>
24646c7e 52#include <net/if.h>
24646c7e 53#include <arpa/inet.h>
6f97dba0
AL		 54#include <netdb.h>
55#include <sys/select.h>
71e72a19 56#ifdef CONFIG_BSD
6f97dba0 57#include <sys/stat.h>
3294ce18
MT		 58#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
59#include <dev/ppbus/ppi.h>
60#include <dev/ppbus/ppbconf.h>
c5e97233 61#elif defined(__DragonFly__)
c5e97233
BS		 62#include <dev/misc/ppi/ppi.h>
63#include <bus/ppbus/ppbconf.h>
6f97dba0 64#endif
bbe813a2 65#else
6f97dba0 66#ifdef __linux__
6f97dba0
AL		 67#include <linux/ppdev.h>
68#include <linux/parport.h>
69#endif
70#ifdef __sun__
71#include <sys/stat.h>
72#include <sys/ethernet.h>
73#include <sys/sockio.h>
74#include <netinet/arp.h>
75#include <netinet/in.h>
76#include <netinet/in_systm.h>
77#include <netinet/ip.h>
78#include <netinet/ip_icmp.h> // must come after ip.h
79#include <netinet/udp.h>
80#include <netinet/tcp.h>
6f97dba0
AL		 81#endif
82#endif
83#endif
84
1de7afc9 85#include "qemu/sockets.h"
cbcc6336 86#include "ui/qemu-spice.h"
6f97dba0 87
9bd7854e 88#define READ_BUF_LEN 4096
7b0bfdf5 89#define READ_RETRIES 10
9f781168 90#define CHR_MAX_FILENAME_SIZE 256
c4095726 91#define TCP_MAX_FDS 16
9bd7854e 92
cfb429cb
CM		 93/***********************************************************/
94/* Socket address helpers */
95static void qapi_copy_SocketAddress(SocketAddress **p_dest,
96 SocketAddress *src)
97{
98 QmpOutputVisitor *qov;
99 QmpInputVisitor *qiv;
100 Visitor *ov, *iv;
101 QObject *obj;
102
103 *p_dest = NULL;
104
105 qov = qmp_output_visitor_new();
106 ov = qmp_output_get_visitor(qov);
107 visit_type_SocketAddress(ov, &src, NULL, &error_abort);
108 obj = qmp_output_get_qobject(qov);
109 qmp_output_visitor_cleanup(qov);
110 if (!obj) {
111 return;
112 }
113
114 qiv = qmp_input_visitor_new(obj);
115 iv = qmp_input_get_visitor(qiv);
116 visit_type_SocketAddress(iv, p_dest, NULL, &error_abort);
117 qmp_input_visitor_cleanup(qiv);
118 qobject_decref(obj);
119}
120
16cc4ffe
CM		 121static int SocketAddress_to_str(char *dest, int max_len,
122 const char *prefix, SocketAddress *addr,
123 bool is_listen, bool is_telnet)
124{
125 switch (addr->kind) {
126 case SOCKET_ADDRESS_KIND_INET:
127 return snprintf(dest, max_len, "%s%s:%s:%s%s", prefix,
128 is_telnet ? "telnet" : "tcp", addr->inet->host,
129 addr->inet->port, is_listen ? ",server" : "");
130 break;
131 case SOCKET_ADDRESS_KIND_UNIX:
132 return snprintf(dest, max_len, "%sunix:%s%s", prefix,
133 addr->q_unix->path, is_listen ? ",server" : "");
134 break;
135 case SOCKET_ADDRESS_KIND_FD:
136 return snprintf(dest, max_len, "%sfd:%s%s", prefix, addr->fd->str,
137 is_listen ? ",server" : "");
138 break;
139 default:
140 abort();
141 }
142}
143
144static int sockaddr_to_str(char *dest, int max_len,
145 struct sockaddr_storage *ss, socklen_t ss_len,
01ca519f 146 struct sockaddr_storage *ps, socklen_t ps_len,
16cc4ffe
CM		 147 bool is_listen, bool is_telnet)
148{
01ca519f
CM		 149 char shost[NI_MAXHOST], sserv[NI_MAXSERV];
150 char phost[NI_MAXHOST], pserv[NI_MAXSERV];
16cc4ffe
CM		 151 const char *left = "", *right = "";
152
153 switch (ss->ss_family) {
154#ifndef _WIN32
155 case AF_UNIX:
156 return snprintf(dest, max_len, "unix:%s%s",
157 ((struct sockaddr_un *)(ss))->sun_path,
158 is_listen ? ",server" : "");
159#endif
160 case AF_INET6:
161 left = "[";
162 right = "]";
163 /* fall through */
164 case AF_INET:
01ca519f
CM		 165 getnameinfo((struct sockaddr *) ss, ss_len, shost, sizeof(shost),
166 sserv, sizeof(sserv), NI_NUMERICHOST | NI_NUMERICSERV);
167 getnameinfo((struct sockaddr *) ps, ps_len, phost, sizeof(phost),
168 pserv, sizeof(pserv), NI_NUMERICHOST | NI_NUMERICSERV);
169 return snprintf(dest, max_len, "%s:%s%s%s:%s%s <-> %s%s%s:%s",
16cc4ffe 170 is_telnet ? "telnet" : "tcp",
01ca519f
CM		 171 left, shost, right, sserv,
172 is_listen ? ",server" : "",
173 left, phost, right, pserv);
16cc4ffe
CM		 174
175 default:
176 return snprintf(dest, max_len, "unknown");
177 }
178}
179
6f97dba0
AL		 180/***********************************************************/
181/* character device */
182
72cf2d4f
BS		 183static QTAILQ_HEAD(CharDriverStateHead, CharDriverState) chardevs =
184 QTAILQ_HEAD_INITIALIZER(chardevs);
2970a6c9 185
db39fcf1
PB		 186CharDriverState *qemu_chr_alloc(void)
187{
188 CharDriverState *chr = g_malloc0(sizeof(CharDriverState));
f3db17b9 189 qemu_mutex_init(&chr->chr_write_lock);
db39fcf1
PB		 190 return chr;
191}
192
a425d23f 193void qemu_chr_be_event(CharDriverState *s, int event)
6f97dba0 194{
73cdf3f2
AG		 195 /* Keep track if the char device is open */
196 switch (event) {
197 case CHR_EVENT_OPENED:
16665b94 198 s->be_open = 1;
73cdf3f2
AG		 199 break;
200 case CHR_EVENT_CLOSED:
16665b94 201 s->be_open = 0;
73cdf3f2
AG		 202 break;
203 }
204
6f97dba0
AL		 205 if (!s->chr_event)
206 return;
207 s->chr_event(s->handler_opaque, event);
208}
209
fee204fd 210void qemu_chr_be_generic_open(CharDriverState *s)
6f97dba0 211{
bd5c51ee 212 qemu_chr_be_event(s, CHR_EVENT_OPENED);
6f97dba0
AL		 213}
214
2cc6e0a1 215int qemu_chr_fe_write(CharDriverState *s, const uint8_t *buf, int len)
6f97dba0 216{
9005b2a7
PB		 217 int ret;
218
219 qemu_mutex_lock(&s->chr_write_lock);
220 ret = s->chr_write(s, buf, len);
221 qemu_mutex_unlock(&s->chr_write_lock);
222 return ret;
6f97dba0
AL		 223}
224
cd18720a
AL		 225int qemu_chr_fe_write_all(CharDriverState *s, const uint8_t *buf, int len)
226{
227 int offset = 0;
09313047 228 int res = 0;
cd18720a 229
9005b2a7 230 qemu_mutex_lock(&s->chr_write_lock);
cd18720a
AL		 231 while (offset < len) {
232 do {
233 res = s->chr_write(s, buf + offset, len - offset);
234 if (res == -1 && errno == EAGAIN) {
235 g_usleep(100);
236 }
237 } while (res == -1 && errno == EAGAIN);
238
9005b2a7 239 if (res <= 0) {
cd18720a
AL		 240 break;
241 }
242
cd18720a
AL		 243 offset += res;
244 }
9005b2a7 245 qemu_mutex_unlock(&s->chr_write_lock);
cd18720a 246
9005b2a7
PB		 247 if (res < 0) {
248 return res;
249 }
cd18720a
AL		 250 return offset;
251}
252
7b0bfdf5
NN		 253int qemu_chr_fe_read_all(CharDriverState *s, uint8_t *buf, int len)
254{
255 int offset = 0, counter = 10;
256 int res;
257
258 if (!s->chr_sync_read) {
259 return 0;
260 }
261
262 while (offset < len) {
263 do {
264 res = s->chr_sync_read(s, buf + offset, len - offset);
265 if (res == -1 && errno == EAGAIN) {
266 g_usleep(100);
267 }
268 } while (res == -1 && errno == EAGAIN);
269
270 if (res == 0) {
271 break;
272 }
273
274 if (res < 0) {
275 return res;
276 }
277
278 offset += res;
279
280 if (!counter--) {
281 break;
282 }
283 }
284
285 return offset;
286}
287
41084f1b 288int qemu_chr_fe_ioctl(CharDriverState *s, int cmd, void *arg)
6f97dba0
AL		 289{
290 if (!s->chr_ioctl)
291 return -ENOTSUP;
292 return s->chr_ioctl(s, cmd, arg);
293}
294
909cda12 295int qemu_chr_be_can_write(CharDriverState *s)
6f97dba0
AL		 296{
297 if (!s->chr_can_read)
298 return 0;
299 return s->chr_can_read(s->handler_opaque);
300}
301
fa5efccb 302void qemu_chr_be_write(CharDriverState *s, uint8_t *buf, int len)
6f97dba0 303{
ac310734
SW		 304 if (s->chr_read) {
305 s->chr_read(s->handler_opaque, buf, len);
306 }
6f97dba0
AL		 307}
308
74c0d6f0 309int qemu_chr_fe_get_msgfd(CharDriverState *s)
7d174059 310{
c76bf6bb 311 int fd;
4f858614 312 return (qemu_chr_fe_get_msgfds(s, &fd, 1) == 1) ? fd : -1;
c76bf6bb
NN		 313}
314
315int qemu_chr_fe_get_msgfds(CharDriverState *s, int *fds, int len)
316{
317 return s->get_msgfds ? s->get_msgfds(s, fds, len) : -1;
7d174059
MM		 318}
319
d39aac7a
NN		 320int qemu_chr_fe_set_msgfds(CharDriverState *s, int *fds, int num)
321{
322 return s->set_msgfds ? s->set_msgfds(s, fds, num) : -1;
323}
324
13661089
DB		 325int qemu_chr_add_client(CharDriverState *s, int fd)
326{
327 return s->chr_add_client ? s->chr_add_client(s, fd) : -1;
328}
329
6f97dba0
AL		 330void qemu_chr_accept_input(CharDriverState *s)
331{
332 if (s->chr_accept_input)
333 s->chr_accept_input(s);
98c8ee1d 334 qemu_notify_event();
6f97dba0
AL		 335}
336
e7e71b0e 337void qemu_chr_fe_printf(CharDriverState *s, const char *fmt, ...)
6f97dba0 338{
9bd7854e 339 char buf[READ_BUF_LEN];
6f97dba0
AL		 340 va_list ap;
341 va_start(ap, fmt);
342 vsnprintf(buf, sizeof(buf), fmt, ap);
2cc6e0a1 343 qemu_chr_fe_write(s, (uint8_t *)buf, strlen(buf));
6f97dba0
AL		 344 va_end(ap);
345}
346
386a5a1e
AS		 347static void remove_fd_in_watch(CharDriverState *chr);
348
6f97dba0 349void qemu_chr_add_handlers(CharDriverState *s,
7b27a769 350 IOCanReadHandler *fd_can_read,
6f97dba0
AL		 351 IOReadHandler *fd_read,
352 IOEventHandler *fd_event,
353 void *opaque)
354{
19083228
HG		 355 int fe_open;
356
da7d998b 357 if (!opaque && !fd_can_read && !fd_read && !fd_event) {
19083228 358 fe_open = 0;
386a5a1e 359 remove_fd_in_watch(s);
19083228
HG		 360 } else {
361 fe_open = 1;
2d6c1ef4 362 }
6f97dba0
AL		 363 s->chr_can_read = fd_can_read;
364 s->chr_read = fd_read;
365 s->chr_event = fd_event;
366 s->handler_opaque = opaque;
ac1b84dd 367 if (fe_open && s->chr_update_read_handler)
6f97dba0 368 s->chr_update_read_handler(s);
73cdf3f2 369
19083228 370 if (!s->explicit_fe_open) {
8e25daa8 371 qemu_chr_fe_set_open(s, fe_open);
19083228
HG		 372 }
373
73cdf3f2
AG		 374 /* We're connecting to an already opened device, so let's make sure we
375 also get the open event */
a59bcd31 376 if (fe_open && s->be_open) {
fee204fd 377 qemu_chr_be_generic_open(s);
73cdf3f2 378 }
6f97dba0
AL		 379}
380
381static int null_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
382{
383 return len;
384}
385
80dca9e6 386static CharDriverState *qemu_chr_open_null(void)
6f97dba0
AL		 387{
388 CharDriverState *chr;
389
db39fcf1 390 chr = qemu_chr_alloc();
6f97dba0 391 chr->chr_write = null_chr_write;
bd5c51ee 392 chr->explicit_be_open = true;
1f51470d 393 return chr;
6f97dba0
AL		 394}
395
396/* MUX driver for serial I/O splitting */
6f97dba0
AL		 397#define MAX_MUX 4
398#define MUX_BUFFER_SIZE 32 /* Must be a power of 2. */
399#define MUX_BUFFER_MASK (MUX_BUFFER_SIZE - 1)
400typedef struct {
7b27a769 401 IOCanReadHandler *chr_can_read[MAX_MUX];
6f97dba0
AL		 402 IOReadHandler *chr_read[MAX_MUX];
403 IOEventHandler *chr_event[MAX_MUX];
404 void *ext_opaque[MAX_MUX];
405 CharDriverState *drv;
799f1f23 406 int focus;
6f97dba0
AL		 407 int mux_cnt;
408 int term_got_escape;
409 int max_size;
a80bf99f
AL		 410 /* Intermediate input buffer allows to catch escape sequences even if the
411 currently active device is not accepting any input - but only until it
412 is full as well. */
413 unsigned char buffer[MAX_MUX][MUX_BUFFER_SIZE];
414 int prod[MAX_MUX];
415 int cons[MAX_MUX];
2d22959d 416 int timestamps;
9005b2a7
PB		 417
418 /* Protected by the CharDriverState chr_write_lock. */
4ab312f7 419 int linestart;
2d22959d 420 int64_t timestamps_start;
6f97dba0
AL		 421} MuxDriver;
422
423
9005b2a7 424/* Called with chr_write_lock held. */
6f97dba0
AL		 425static int mux_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
426{
427 MuxDriver *d = chr->opaque;
428 int ret;
2d22959d 429 if (!d->timestamps) {
6975b713 430 ret = qemu_chr_fe_write(d->drv, buf, len);
6f97dba0
AL		 431 } else {
432 int i;
433
434 ret = 0;
4ab312f7
JK		 435 for (i = 0; i < len; i++) {
436 if (d->linestart) {
6f97dba0
AL		 437 char buf1[64];
438 int64_t ti;
439 int secs;
440
bc72ad67 441 ti = qemu_clock_get_ms(QEMU_CLOCK_REALTIME);
2d22959d
JK		 442 if (d->timestamps_start == -1)
443 d->timestamps_start = ti;
444 ti -= d->timestamps_start;
a4bb1db8 445 secs = ti / 1000;
6f97dba0
AL		 446 snprintf(buf1, sizeof(buf1),
447 "[%02d:%02d:%02d.%03d] ",
448 secs / 3600,
449 (secs / 60) % 60,
450 secs % 60,
a4bb1db8 451 (int)(ti % 1000));
6975b713 452 qemu_chr_fe_write(d->drv, (uint8_t *)buf1, strlen(buf1));
4ab312f7
JK		 453 d->linestart = 0;
454 }
6975b713 455 ret += qemu_chr_fe_write(d->drv, buf+i, 1);
4ab312f7
JK		 456 if (buf[i] == '\n') {
457 d->linestart = 1;
6f97dba0
AL		 458 }
459 }
460 }
461 return ret;
462}
463
464static const char * const mux_help[] = {
465 "% h print this help\n\r",
466 "% x exit emulator\n\r",
467 "% s save disk data back to file (if -snapshot)\n\r",
86d10328 468 "% t toggle console timestamps\n\r",
6f97dba0
AL		 469 "% b send break (magic sysrq)\n\r",
470 "% c switch between console and monitor\n\r",
471 "% % sends %\n\r",
472 NULL
473};
474
475int term_escape_char = 0x01; /* ctrl-a is used for escape */
476static void mux_print_help(CharDriverState *chr)
477{
478 int i, j;
479 char ebuf[15] = "Escape-Char";
480 char cbuf[50] = "\n\r";
481
482 if (term_escape_char > 0 && term_escape_char < 26) {
483 snprintf(cbuf, sizeof(cbuf), "\n\r");
484 snprintf(ebuf, sizeof(ebuf), "C-%c", term_escape_char - 1 + 'a');
485 } else {
486 snprintf(cbuf, sizeof(cbuf),
487 "\n\rEscape-Char set to Ascii: 0x%02x\n\r\n\r",
488 term_escape_char);
489 }
6975b713 490 qemu_chr_fe_write(chr, (uint8_t *)cbuf, strlen(cbuf));
6f97dba0
AL		 491 for (i = 0; mux_help[i] != NULL; i++) {
492 for (j=0; mux_help[i][j] != '\0'; j++) {
493 if (mux_help[i][j] == '%')
6975b713 494 qemu_chr_fe_write(chr, (uint8_t *)ebuf, strlen(ebuf));
6f97dba0 495 else
6975b713 496 qemu_chr_fe_write(chr, (uint8_t *)&mux_help[i][j], 1);
6f97dba0
AL		 497 }
498 }
499}
500
2724b180
AL		 501static void mux_chr_send_event(MuxDriver *d, int mux_nr, int event)
502{
503 if (d->chr_event[mux_nr])
504 d->chr_event[mux_nr](d->ext_opaque[mux_nr], event);
505}
506
6f97dba0
AL		 507static int mux_proc_byte(CharDriverState *chr, MuxDriver *d, int ch)
508{
509 if (d->term_got_escape) {
510 d->term_got_escape = 0;
511 if (ch == term_escape_char)
512 goto send_char;
513 switch(ch) {
514 case '?':
515 case 'h':
516 mux_print_help(chr);
517 break;
518 case 'x':
519 {
520 const char *term = "QEMU: Terminated\n\r";
6975b713 521 qemu_chr_fe_write(chr, (uint8_t *)term, strlen(term));
6f97dba0
AL		 522 exit(0);
523 break;
524 }
525 case 's':
6ab4b5ab 526 bdrv_commit_all();
6f97dba0
AL		 527 break;
528 case 'b':
a425d23f 529 qemu_chr_be_event(chr, CHR_EVENT_BREAK);
6f97dba0
AL		 530 break;
531 case 'c':
532 /* Switch to the next registered device */
799f1f23
GH		 533 mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_OUT);
534 d->focus++;
535 if (d->focus >= d->mux_cnt)
536 d->focus = 0;
537 mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_IN);
6f97dba0 538 break;
2d22959d
JK		 539 case 't':
540 d->timestamps = !d->timestamps;
541 d->timestamps_start = -1;
4ab312f7 542 d->linestart = 0;
2d22959d 543 break;
6f97dba0
AL		 544 }
545 } else if (ch == term_escape_char) {
546 d->term_got_escape = 1;
547 } else {
548 send_char:
549 return 1;
550 }
551 return 0;
552}
553
554static void mux_chr_accept_input(CharDriverState *chr)
555{
6f97dba0 556 MuxDriver *d = chr->opaque;
799f1f23 557 int m = d->focus;
6f97dba0 558
a80bf99f 559 while (d->prod[m] != d->cons[m] &&
6f97dba0
AL		 560 d->chr_can_read[m] &&
561 d->chr_can_read[m](d->ext_opaque[m])) {
562 d->chr_read[m](d->ext_opaque[m],
a80bf99f 563 &d->buffer[m][d->cons[m]++ & MUX_BUFFER_MASK], 1);
6f97dba0
AL		 564 }
565}
566
567static int mux_chr_can_read(void *opaque)
568{
569 CharDriverState *chr = opaque;
570 MuxDriver *d = chr->opaque;
799f1f23 571 int m = d->focus;
6f97dba0 572
a80bf99f 573 if ((d->prod[m] - d->cons[m]) < MUX_BUFFER_SIZE)
6f97dba0 574 return 1;
a80bf99f
AL		 575 if (d->chr_can_read[m])
576 return d->chr_can_read[m](d->ext_opaque[m]);
6f97dba0
AL		 577 return 0;
578}
579
580static void mux_chr_read(void *opaque, const uint8_t *buf, int size)
581{
582 CharDriverState *chr = opaque;
583 MuxDriver *d = chr->opaque;
799f1f23 584 int m = d->focus;
6f97dba0
AL		 585 int i;
586
587 mux_chr_accept_input (opaque);
588
589 for(i = 0; i < size; i++)
590 if (mux_proc_byte(chr, d, buf[i])) {
a80bf99f 591 if (d->prod[m] == d->cons[m] &&
6f97dba0
AL		 592 d->chr_can_read[m] &&
593 d->chr_can_read[m](d->ext_opaque[m]))
594 d->chr_read[m](d->ext_opaque[m], &buf[i], 1);
595 else
a80bf99f 596 d->buffer[m][d->prod[m]++ & MUX_BUFFER_MASK] = buf[i];
6f97dba0
AL		 597 }
598}
599
600static void mux_chr_event(void *opaque, int event)
601{
602 CharDriverState *chr = opaque;
603 MuxDriver *d = chr->opaque;
604 int i;
605
606 /* Send the event to all registered listeners */
607 for (i = 0; i < d->mux_cnt; i++)
2724b180 608 mux_chr_send_event(d, i, event);
6f97dba0
AL		 609}
610
611static void mux_chr_update_read_handler(CharDriverState *chr)
612{
613 MuxDriver *d = chr->opaque;
614
615 if (d->mux_cnt >= MAX_MUX) {
616 fprintf(stderr, "Cannot add I/O handlers, MUX array is full\n");
617 return;
618 }
619 d->ext_opaque[d->mux_cnt] = chr->handler_opaque;
620 d->chr_can_read[d->mux_cnt] = chr->chr_can_read;
621 d->chr_read[d->mux_cnt] = chr->chr_read;
622 d->chr_event[d->mux_cnt] = chr->chr_event;
623 /* Fix up the real driver with mux routines */
624 if (d->mux_cnt == 0) {
625 qemu_chr_add_handlers(d->drv, mux_chr_can_read, mux_chr_read,
626 mux_chr_event, chr);
627 }
799f1f23
GH		 628 if (d->focus != -1) {
629 mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_OUT);
a7aec5da 630 }
799f1f23 631 d->focus = d->mux_cnt;
6f97dba0 632 d->mux_cnt++;
799f1f23 633 mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_IN);
6f97dba0
AL		 634}
635
7b7ab18d
MR		 636static bool muxes_realized;
637
638/**
639 * Called after processing of default and command-line-specified
640 * chardevs to deliver CHR_EVENT_OPENED events to any FEs attached
641 * to a mux chardev. This is done here to ensure that
642 * output/prompts/banners are only displayed for the FE that has
643 * focus when initial command-line processing/machine init is
644 * completed.
645 *
646 * After this point, any new FE attached to any new or existing
647 * mux will receive CHR_EVENT_OPENED notifications for the BE
648 * immediately.
649 */
650static void muxes_realize_done(Notifier *notifier, void *unused)
651{
652 CharDriverState *chr;
653
654 QTAILQ_FOREACH(chr, &chardevs, next) {
655 if (chr->is_mux) {
656 MuxDriver *d = chr->opaque;
657 int i;
658
659 /* send OPENED to all already-attached FEs */
660 for (i = 0; i < d->mux_cnt; i++) {
661 mux_chr_send_event(d, i, CHR_EVENT_OPENED);
662 }
663 /* mark mux as OPENED so any new FEs will immediately receive
664 * OPENED event
665 */
666 qemu_chr_be_generic_open(chr);
667 }
668 }
669 muxes_realized = true;
670}
671
672static Notifier muxes_realize_notify = {
673 .notify = muxes_realize_done,
674};
675
3f0838ab
KB		 676static GSource *mux_chr_add_watch(CharDriverState *s, GIOCondition cond)
677{
678 MuxDriver *d = s->opaque;
679 return d->drv->chr_add_watch(d->drv, cond);
680}
681
6f97dba0
AL		 682static CharDriverState *qemu_chr_open_mux(CharDriverState *drv)
683{
684 CharDriverState *chr;
685 MuxDriver *d;
686
db39fcf1 687 chr = qemu_chr_alloc();
2d528d45 688 d = g_new0(MuxDriver, 1);
6f97dba0
AL		 689
690 chr->opaque = d;
691 d->drv = drv;
799f1f23 692 d->focus = -1;
6f97dba0
AL		 693 chr->chr_write = mux_chr_write;
694 chr->chr_update_read_handler = mux_chr_update_read_handler;
695 chr->chr_accept_input = mux_chr_accept_input;
7c32c4fe 696 /* Frontend guest-open / -close notification is not support with muxes */
574b711a 697 chr->chr_set_fe_open = NULL;
3f0838ab
KB		 698 if (drv->chr_add_watch) {
699 chr->chr_add_watch = mux_chr_add_watch;
700 }
7b7ab18d
MR		 701 /* only default to opened state if we've realized the initial
702 * set of muxes
703 */
704 chr->explicit_be_open = muxes_realized ? 0 : 1;
705 chr->is_mux = 1;
73cdf3f2 706
6f97dba0
AL		 707 return chr;
708}
709
710
711#ifdef _WIN32
d247d25f 712int send_all(int fd, const void *buf, int len1)
6f97dba0
AL		 713{
714 int ret, len;
715
716 len = len1;
717 while (len > 0) {
718 ret = send(fd, buf, len, 0);
719 if (ret < 0) {
6f97dba0
AL		 720 errno = WSAGetLastError();
721 if (errno != WSAEWOULDBLOCK) {
722 return -1;
723 }
724 } else if (ret == 0) {
725 break;
726 } else {
727 buf += ret;
728 len -= ret;
729 }
730 }
731 return len1 - len;
732}
733
734#else
735
5fc9cfed 736int send_all(int fd, const void *_buf, int len1)
6f97dba0
AL		 737{
738 int ret, len;
5fc9cfed 739 const uint8_t *buf = _buf;
6f97dba0
AL		 740
741 len = len1;
742 while (len > 0) {
743 ret = write(fd, buf, len);
744 if (ret < 0) {
745 if (errno != EINTR && errno != EAGAIN)
746 return -1;
747 } else if (ret == 0) {
748 break;
749 } else {
750 buf += ret;
751 len -= ret;
752 }
753 }
754 return len1 - len;
755}
4549a8b7
SB		 756
757int recv_all(int fd, void *_buf, int len1, bool single_read)
758{
759 int ret, len;
760 uint8_t *buf = _buf;
761
762 len = len1;
763 while ((len > 0) && (ret = read(fd, buf, len)) != 0) {
764 if (ret < 0) {
765 if (errno != EINTR && errno != EAGAIN) {
766 return -1;
767 }
768 continue;
769 } else {
770 if (single_read) {
771 return ret;
772 }
773 buf += ret;
774 len -= ret;
775 }
776 }
777 return len1 - len;
778}
779
6f97dba0
AL		 780#endif /* !_WIN32 */
781
96c63847
AL		 782typedef struct IOWatchPoll
783{
d185c094
PB		 784 GSource parent;
785
1e885b25 786 GIOChannel *channel;
96c63847 787 GSource *src;
96c63847
AL		 788
789 IOCanReadHandler *fd_can_read;
1e885b25 790 GSourceFunc fd_read;
96c63847 791 void *opaque;
96c63847
AL		 792} IOWatchPoll;
793
96c63847
AL		 794static IOWatchPoll *io_watch_poll_from_source(GSource *source)
795{
d185c094 796 return container_of(source, IOWatchPoll, parent);
96c63847
AL		 797}
798
799static gboolean io_watch_poll_prepare(GSource *source, gint *timeout_)
800{
801 IOWatchPoll *iwp = io_watch_poll_from_source(source);
d185c094 802 bool now_active = iwp->fd_can_read(iwp->opaque) > 0;
1e885b25 803 bool was_active = iwp->src != NULL;
d185c094 804 if (was_active == now_active) {
96c63847
AL		 805 return FALSE;
806 }
807
d185c094 808 if (now_active) {
4bf1cb03
NC		 809 iwp->src = g_io_create_watch(iwp->channel,
810 G_IO_IN | G_IO_ERR | G_IO_HUP | G_IO_NVAL);
1e885b25 811 g_source_set_callback(iwp->src, iwp->fd_read, iwp->opaque, NULL);
d185c094
PB		 812 g_source_attach(iwp->src, NULL);
813 } else {
1e885b25
PB		 814 g_source_destroy(iwp->src);
815 g_source_unref(iwp->src);
816 iwp->src = NULL;
d185c094
PB		 817 }
818 return FALSE;
96c63847
AL		 819}
820
821static gboolean io_watch_poll_check(GSource *source)
822{
d185c094 823 return FALSE;
96c63847
AL		 824}
825
826static gboolean io_watch_poll_dispatch(GSource *source, GSourceFunc callback,
827 gpointer user_data)
828{
d185c094 829 abort();
96c63847
AL		 830}
831
832static void io_watch_poll_finalize(GSource *source)
833{
2b316774
PB		 834 /* Due to a glib bug, removing the last reference to a source
835 * inside a finalize callback causes recursive locking (and a
836 * deadlock). This is not a problem inside other callbacks,
837 * including dispatch callbacks, so we call io_remove_watch_poll
838 * to remove this source. At this point, iwp->src must
839 * be NULL, or we would leak it.
840 *
841 * This would be solved much more elegantly by child sources,
842 * but we support older glib versions that do not have them.
843 */
96c63847 844 IOWatchPoll *iwp = io_watch_poll_from_source(source);
2b316774 845 assert(iwp->src == NULL);
96c63847
AL		 846}
847
848static GSourceFuncs io_watch_poll_funcs = {
849 .prepare = io_watch_poll_prepare,
850 .check = io_watch_poll_check,
851 .dispatch = io_watch_poll_dispatch,
852 .finalize = io_watch_poll_finalize,
853};
854
855/* Can only be used for read */
856static guint io_add_watch_poll(GIOChannel *channel,
857 IOCanReadHandler *fd_can_read,
858 GIOFunc fd_read,
859 gpointer user_data)
860{
861 IOWatchPoll *iwp;
0ca5aa4f 862 int tag;
96c63847 863
d185c094 864 iwp = (IOWatchPoll *) g_source_new(&io_watch_poll_funcs, sizeof(IOWatchPoll));
96c63847
AL		 865 iwp->fd_can_read = fd_can_read;
866 iwp->opaque = user_data;
1e885b25
PB		 867 iwp->channel = channel;
868 iwp->fd_read = (GSourceFunc) fd_read;
869 iwp->src = NULL;
96c63847 870
0ca5aa4f
PB		 871 tag = g_source_attach(&iwp->parent, NULL);
872 g_source_unref(&iwp->parent);
873 return tag;
96c63847
AL		 874}
875
2b316774
PB		 876static void io_remove_watch_poll(guint tag)
877{
878 GSource *source;
879 IOWatchPoll *iwp;
880
881 g_return_if_fail (tag > 0);
882
883 source = g_main_context_find_source_by_id(NULL, tag);
884 g_return_if_fail (source != NULL);
885
886 iwp = io_watch_poll_from_source(source);
887 if (iwp->src) {
888 g_source_destroy(iwp->src);
889 g_source_unref(iwp->src);
890 iwp->src = NULL;
891 }
892 g_source_destroy(&iwp->parent);
893}
894
26da70c7
AS		 895static void remove_fd_in_watch(CharDriverState *chr)
896{
897 if (chr->fd_in_tag) {
898 io_remove_watch_poll(chr->fd_in_tag);
899 chr->fd_in_tag = 0;
900 }
901}
902
44ab9ed4 903#ifndef _WIN32
96c63847
AL		 904static GIOChannel *io_channel_from_fd(int fd)
905{
906 GIOChannel *chan;
907
908 if (fd == -1) {
909 return NULL;
910 }
911
912 chan = g_io_channel_unix_new(fd);
913
914 g_io_channel_set_encoding(chan, NULL, NULL);
915 g_io_channel_set_buffered(chan, FALSE);
916
917 return chan;
918}
44ab9ed4 919#endif
96c63847 920
76a9644b
AL		 921static GIOChannel *io_channel_from_socket(int fd)
922{
923 GIOChannel *chan;
924
925 if (fd == -1) {
926 return NULL;
927 }
928
929#ifdef _WIN32
930 chan = g_io_channel_win32_new_socket(fd);
931#else
932 chan = g_io_channel_unix_new(fd);
933#endif
934
935 g_io_channel_set_encoding(chan, NULL, NULL);
936 g_io_channel_set_buffered(chan, FALSE);
937
938 return chan;
939}
940
684a096e 941static int io_channel_send(GIOChannel *fd, const void *buf, size_t len)
96c63847 942{
ac8c26f6
LE		 943 size_t offset = 0;
944 GIOStatus status = G_IO_STATUS_NORMAL;
96c63847 945
ac8c26f6
LE		 946 while (offset < len && status == G_IO_STATUS_NORMAL) {
947 gsize bytes_written = 0;
684a096e
AL		 948
949 status = g_io_channel_write_chars(fd, buf + offset, len - offset,
96c63847 950 &bytes_written, NULL);
684a096e 951 offset += bytes_written;
96c63847 952 }
684a096e 953
ac8c26f6
LE		 954 if (offset > 0) {
955 return offset;
956 }
957 switch (status) {
958 case G_IO_STATUS_NORMAL:
959 g_assert(len == 0);
960 return 0;
961 case G_IO_STATUS_AGAIN:
962 errno = EAGAIN;
963 return -1;
964 default:
965 break;
966 }
967 errno = EINVAL;
968 return -1;
96c63847 969}
96c63847 970
44ab9ed4
BS		 971#ifndef _WIN32
972
a29753f8
AL		 973typedef struct FDCharDriver {
974 CharDriverState *chr;
975 GIOChannel *fd_in, *fd_out;
6f97dba0
AL		 976 int max_size;
977} FDCharDriver;
978
9005b2a7 979/* Called with chr_write_lock held. */
6f97dba0
AL		 980static int fd_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
981{
982 FDCharDriver *s = chr->opaque;
a29753f8 983
684a096e 984 return io_channel_send(s->fd_out, buf, len);
6f97dba0
AL		 985}
986
a29753f8 987static gboolean fd_chr_read(GIOChannel *chan, GIOCondition cond, void *opaque)
6f97dba0
AL		 988{
989 CharDriverState *chr = opaque;
990 FDCharDriver *s = chr->opaque;
a29753f8 991 int len;
9bd7854e 992 uint8_t buf[READ_BUF_LEN];
a29753f8
AL		 993 GIOStatus status;
994 gsize bytes_read;
6f97dba0
AL		 995
996 len = sizeof(buf);
a29753f8 997 if (len > s->max_size) {
6f97dba0 998 len = s->max_size;
a29753f8
AL		 999 }
1000 if (len == 0) {
cdbf6e16 1001 return TRUE;
a29753f8
AL		 1002 }
1003
1004 status = g_io_channel_read_chars(chan, (gchar *)buf,
1005 len, &bytes_read, NULL);
1006 if (status == G_IO_STATUS_EOF) {
26da70c7 1007 remove_fd_in_watch(chr);
a425d23f 1008 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
a29753f8 1009 return FALSE;
6f97dba0 1010 }
a29753f8
AL		 1011 if (status == G_IO_STATUS_NORMAL) {
1012 qemu_chr_be_write(chr, buf, bytes_read);
6f97dba0 1013 }
a29753f8
AL		 1014
1015 return TRUE;
1016}
1017
1018static int fd_chr_read_poll(void *opaque)
1019{
1020 CharDriverState *chr = opaque;
1021 FDCharDriver *s = chr->opaque;
1022
1023 s->max_size = qemu_chr_be_can_write(chr);
1024 return s->max_size;
6f97dba0
AL		 1025}
1026
23673ca7
AL		 1027static GSource *fd_chr_add_watch(CharDriverState *chr, GIOCondition cond)
1028{
1029 FDCharDriver *s = chr->opaque;
1030 return g_io_create_watch(s->fd_out, cond);
1031}
1032
6f97dba0
AL		 1033static void fd_chr_update_read_handler(CharDriverState *chr)
1034{
1035 FDCharDriver *s = chr->opaque;
1036
26da70c7 1037 remove_fd_in_watch(chr);
a29753f8 1038 if (s->fd_in) {
7ba9addc
AS		 1039 chr->fd_in_tag = io_add_watch_poll(s->fd_in, fd_chr_read_poll,
1040 fd_chr_read, chr);
6f97dba0
AL		 1041 }
1042}
1043
1044static void fd_chr_close(struct CharDriverState *chr)
1045{
1046 FDCharDriver *s = chr->opaque;
1047
26da70c7 1048 remove_fd_in_watch(chr);
a29753f8
AL		 1049 if (s->fd_in) {
1050 g_io_channel_unref(s->fd_in);
1051 }
1052 if (s->fd_out) {
1053 g_io_channel_unref(s->fd_out);
6f97dba0
AL		 1054 }
1055
7267c094 1056 g_free(s);
a425d23f 1057 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
6f97dba0
AL		 1058}
1059
1060/* open a character device to a unix fd */
1061static CharDriverState *qemu_chr_open_fd(int fd_in, int fd_out)
1062{
1063 CharDriverState *chr;
1064 FDCharDriver *s;
1065
db39fcf1 1066 chr = qemu_chr_alloc();
2d528d45 1067 s = g_new0(FDCharDriver, 1);
a29753f8
AL		 1068 s->fd_in = io_channel_from_fd(fd_in);
1069 s->fd_out = io_channel_from_fd(fd_out);
4ff12bdb 1070 qemu_set_nonblock(fd_out);
a29753f8 1071 s->chr = chr;
6f97dba0 1072 chr->opaque = s;
23673ca7 1073 chr->chr_add_watch = fd_chr_add_watch;
6f97dba0
AL		 1074 chr->chr_write = fd_chr_write;
1075 chr->chr_update_read_handler = fd_chr_update_read_handler;
1076 chr->chr_close = fd_chr_close;
1077
6f97dba0
AL		 1078 return chr;
1079}
1080
20cbe7a2
PB		 1081static CharDriverState *qemu_chr_open_pipe(const char *id,
1082 ChardevBackend *backend,
1083 ChardevReturn *ret,
1084 Error **errp)
6f97dba0 1085{
20cbe7a2 1086 ChardevHostdev *opts = backend->pipe;
6f97dba0 1087 int fd_in, fd_out;
9f781168
CM		 1088 char filename_in[CHR_MAX_FILENAME_SIZE];
1089 char filename_out[CHR_MAX_FILENAME_SIZE];
548cbb36 1090 const char *filename = opts->device;
7d31544f 1091
9f781168
CM		 1092 snprintf(filename_in, CHR_MAX_FILENAME_SIZE, "%s.in", filename);
1093 snprintf(filename_out, CHR_MAX_FILENAME_SIZE, "%s.out", filename);
40ff6d7e
KW		 1094 TFR(fd_in = qemu_open(filename_in, O_RDWR | O_BINARY));
1095 TFR(fd_out = qemu_open(filename_out, O_RDWR | O_BINARY));
6f97dba0
AL		 1096 if (fd_in < 0 || fd_out < 0) {
1097 if (fd_in >= 0)
1098 close(fd_in);
1099 if (fd_out >= 0)
1100 close(fd_out);
b181e047 1101 TFR(fd_in = fd_out = qemu_open(filename, O_RDWR | O_BINARY));
a89dd6c3 1102 if (fd_in < 0) {
20cbe7a2 1103 error_setg_file_open(errp, errno, filename);
1f51470d 1104 return NULL;
a89dd6c3 1105 }
6f97dba0 1106 }
1f51470d 1107 return qemu_chr_open_fd(fd_in, fd_out);
6f97dba0
AL		 1108}
1109
6f97dba0
AL		 1110/* init terminal so that we can grab keys */
1111static struct termios oldtty;
1112static int old_fd0_flags;
c88930a6 1113static bool stdio_in_use;
bb002513 1114static bool stdio_allow_signal;
e76d4420
GH		 1115static bool stdio_echo_state;
1116
1117static void qemu_chr_set_echo_stdio(CharDriverState *chr, bool echo);
6f97dba0
AL		 1118
1119static void term_exit(void)
1120{
1121 tcsetattr (0, TCSANOW, &oldtty);
1122 fcntl(0, F_SETFL, old_fd0_flags);
1123}
1124
e76d4420
GH		 1125static void term_stdio_handler(int sig)
1126{
1127 /* restore echo after resume from suspend. */
1128 qemu_chr_set_echo_stdio(NULL, stdio_echo_state);
1129}
1130
bb002513 1131static void qemu_chr_set_echo_stdio(CharDriverState *chr, bool echo)
6f97dba0
AL		 1132{
1133 struct termios tty;
1134
e76d4420 1135 stdio_echo_state = echo;
0369364b 1136 tty = oldtty;
bb002513
PB		 1137 if (!echo) {
1138 tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
6f97dba0 1139 |INLCR|IGNCR|ICRNL|IXON);
bb002513
PB		 1140 tty.c_oflag |= OPOST;
1141 tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN);
1142 tty.c_cflag &= ~(CSIZE|PARENB);
1143 tty.c_cflag |= CS8;
1144 tty.c_cc[VMIN] = 1;
1145 tty.c_cc[VTIME] = 0;
1146 }
bb002513 1147 if (!stdio_allow_signal)
6f97dba0 1148 tty.c_lflag &= ~ISIG;
6f97dba0
AL		 1149
1150 tcsetattr (0, TCSANOW, &tty);
6f97dba0
AL		 1151}
1152
1153static void qemu_chr_close_stdio(struct CharDriverState *chr)
1154{
1155 term_exit();
6f97dba0
AL		 1156 fd_chr_close(chr);
1157}
1158
7c358031 1159static CharDriverState *qemu_chr_open_stdio(ChardevStdio *opts)
6f97dba0
AL		 1160{
1161 CharDriverState *chr;
e76d4420 1162 struct sigaction act;
6f97dba0 1163
ab51b1d5
MT		 1164 if (is_daemonized()) {
1165 error_report("cannot use stdio with -daemonize");
1166 return NULL;
1167 }
c88930a6
LL		 1168
1169 if (stdio_in_use) {
1170 error_report("cannot use stdio by multiple character devices");
1171 exit(1);
1172 }
1173
1174 stdio_in_use = true;
ed7a1540 1175 old_fd0_flags = fcntl(0, F_GETFL);
c88930a6 1176 tcgetattr(0, &oldtty);
4ff12bdb 1177 qemu_set_nonblock(0);
ed7a1540 1178 atexit(term_exit);
0369364b 1179
e76d4420
GH		 1180 memset(&act, 0, sizeof(act));
1181 act.sa_handler = term_stdio_handler;
1182 sigaction(SIGCONT, &act, NULL);
1183
6f97dba0
AL		 1184 chr = qemu_chr_open_fd(0, 1);
1185 chr->chr_close = qemu_chr_close_stdio;
bb002513 1186 chr->chr_set_echo = qemu_chr_set_echo_stdio;
7c358031
GH		 1187 if (opts->has_signal) {
1188 stdio_allow_signal = opts->signal;
1189 }
15f31519 1190 qemu_chr_fe_set_echo(chr, false);
6f97dba0 1191
1f51470d 1192 return chr;
6f97dba0
AL		 1193}
1194
6f97dba0 1195#if defined(__linux__) || defined(__sun__) || defined(__FreeBSD__) \
a167ba50
AJ		 1196 || defined(__NetBSD__) || defined(__OpenBSD__) || defined(__DragonFly__) \
1197 || defined(__GLIBC__)
6f97dba0 1198
d809ab95
PB		 1199#define HAVE_CHARDEV_SERIAL 1
1200#define HAVE_CHARDEV_PTY 1
e551498e 1201
6f97dba0 1202typedef struct {
093d3a20 1203 GIOChannel *fd;
6f97dba0 1204 int read_bytes;
9005b2a7
PB		 1205
1206 /* Protected by the CharDriverState chr_write_lock. */
1207 int connected;
8aa33caf 1208 guint timer_tag;
7b3621f4 1209 guint open_tag;
6f97dba0
AL		 1210} PtyCharDriver;
1211
9005b2a7 1212static void pty_chr_update_read_handler_locked(CharDriverState *chr);
6f97dba0
AL		 1213static void pty_chr_state(CharDriverState *chr, int connected);
1214
8aa33caf
AL		 1215static gboolean pty_chr_timer(gpointer opaque)
1216{
1217 struct CharDriverState *chr = opaque;
1218 PtyCharDriver *s = chr->opaque;
1219
9005b2a7 1220 qemu_mutex_lock(&chr->chr_write_lock);
79f20075 1221 s->timer_tag = 0;
7b3621f4 1222 s->open_tag = 0;
b0d768c3
GH		 1223 if (!s->connected) {
1224 /* Next poll ... */
9005b2a7 1225 pty_chr_update_read_handler_locked(chr);
b0d768c3 1226 }
9005b2a7 1227 qemu_mutex_unlock(&chr->chr_write_lock);
8aa33caf
AL		 1228 return FALSE;
1229}
1230
9005b2a7 1231/* Called with chr_write_lock held. */
8aa33caf
AL		 1232static void pty_chr_rearm_timer(CharDriverState *chr, int ms)
1233{
1234 PtyCharDriver *s = chr->opaque;
1235
1236 if (s->timer_tag) {
1237 g_source_remove(s->timer_tag);
1238 s->timer_tag = 0;
1239 }
1240
1241 if (ms == 1000) {
1242 s->timer_tag = g_timeout_add_seconds(1, pty_chr_timer, chr);
1243 } else {
1244 s->timer_tag = g_timeout_add(ms, pty_chr_timer, chr);
1245 }
1246}
1247
9005b2a7
PB		 1248/* Called with chr_write_lock held. */
1249static void pty_chr_update_read_handler_locked(CharDriverState *chr)
1bb7fe72
PB		 1250{
1251 PtyCharDriver *s = chr->opaque;
1252 GPollFD pfd;
1253
1254 pfd.fd = g_io_channel_unix_get_fd(s->fd);
1255 pfd.events = G_IO_OUT;
1256 pfd.revents = 0;
1257 g_poll(&pfd, 1, 0);
1258 if (pfd.revents & G_IO_HUP) {
1259 pty_chr_state(chr, 0);
1260 } else {
1261 pty_chr_state(chr, 1);
1262 }
1263}
1264
9005b2a7
PB		 1265static void pty_chr_update_read_handler(CharDriverState *chr)
1266{
1267 qemu_mutex_lock(&chr->chr_write_lock);
1268 pty_chr_update_read_handler_locked(chr);
1269 qemu_mutex_unlock(&chr->chr_write_lock);
1270}
1271
1272/* Called with chr_write_lock held. */
6f97dba0
AL		 1273static int pty_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1274{
1275 PtyCharDriver *s = chr->opaque;
1276
1277 if (!s->connected) {
1278 /* guest sends data, check for (re-)connect */
9005b2a7 1279 pty_chr_update_read_handler_locked(chr);
cf7330c7
ST		 1280 if (!s->connected) {
1281 return 0;
1282 }
6f97dba0 1283 }
684a096e 1284 return io_channel_send(s->fd, buf, len);
6f97dba0
AL		 1285}
1286
e6a87ed8
AL		 1287static GSource *pty_chr_add_watch(CharDriverState *chr, GIOCondition cond)
1288{
1289 PtyCharDriver *s = chr->opaque;
62c339c5
PB		 1290 if (!s->connected) {
1291 return NULL;
1292 }
e6a87ed8
AL		 1293 return g_io_create_watch(s->fd, cond);
1294}
1295
6f97dba0
AL		 1296static int pty_chr_read_poll(void *opaque)
1297{
1298 CharDriverState *chr = opaque;
1299 PtyCharDriver *s = chr->opaque;
1300
909cda12 1301 s->read_bytes = qemu_chr_be_can_write(chr);
6f97dba0
AL		 1302 return s->read_bytes;
1303}
1304
093d3a20 1305static gboolean pty_chr_read(GIOChannel *chan, GIOCondition cond, void *opaque)
6f97dba0
AL		 1306{
1307 CharDriverState *chr = opaque;
1308 PtyCharDriver *s = chr->opaque;
093d3a20 1309 gsize size, len;
9bd7854e 1310 uint8_t buf[READ_BUF_LEN];
093d3a20 1311 GIOStatus status;
6f97dba0
AL		 1312
1313 len = sizeof(buf);
1314 if (len > s->read_bytes)
1315 len = s->read_bytes;
cdbf6e16
PB		 1316 if (len == 0) {
1317 return TRUE;
1318 }
093d3a20
AL		 1319 status = g_io_channel_read_chars(s->fd, (gchar *)buf, len, &size, NULL);
1320 if (status != G_IO_STATUS_NORMAL) {
6f97dba0 1321 pty_chr_state(chr, 0);
093d3a20
AL		 1322 return FALSE;
1323 } else {
6f97dba0 1324 pty_chr_state(chr, 1);
fa5efccb 1325 qemu_chr_be_write(chr, buf, size);
6f97dba0 1326 }
093d3a20 1327 return TRUE;
6f97dba0
AL		 1328}
1329
7b3621f4
PB		 1330static gboolean qemu_chr_be_generic_open_func(gpointer opaque)
1331{
1332 CharDriverState *chr = opaque;
1333 PtyCharDriver *s = chr->opaque;
1334
1335 s->open_tag = 0;
1336 qemu_chr_be_generic_open(chr);
1337 return FALSE;
1338}
1339
9005b2a7 1340/* Called with chr_write_lock held. */
6f97dba0
AL		 1341static void pty_chr_state(CharDriverState *chr, int connected)
1342{
1343 PtyCharDriver *s = chr->opaque;
1344
1345 if (!connected) {
7b3621f4
PB		 1346 if (s->open_tag) {
1347 g_source_remove(s->open_tag);
1348 s->open_tag = 0;
1349 }
26da70c7 1350 remove_fd_in_watch(chr);
6f97dba0 1351 s->connected = 0;
6f97dba0
AL		 1352 /* (re-)connect poll interval for idle guests: once per second.
1353 * We check more frequently in case the guests sends data to
1354 * the virtual device linked to our pty. */
8aa33caf 1355 pty_chr_rearm_timer(chr, 1000);
6f97dba0 1356 } else {
85a67692
PB		 1357 if (s->timer_tag) {
1358 g_source_remove(s->timer_tag);
1359 s->timer_tag = 0;
1360 }
1361 if (!s->connected) {
7b3621f4 1362 g_assert(s->open_tag == 0);
85a67692 1363 s->connected = 1;
7b3621f4 1364 s->open_tag = g_idle_add(qemu_chr_be_generic_open_func, chr);
ac1b84dd
GH		 1365 }
1366 if (!chr->fd_in_tag) {
7ba9addc
AS		 1367 chr->fd_in_tag = io_add_watch_poll(s->fd, pty_chr_read_poll,
1368 pty_chr_read, chr);
85a67692 1369 }
6f97dba0
AL		 1370 }
1371}
1372
6f97dba0
AL		 1373static void pty_chr_close(struct CharDriverState *chr)
1374{
1375 PtyCharDriver *s = chr->opaque;
093d3a20 1376 int fd;
6f97dba0 1377
7b3621f4
PB		 1378 qemu_mutex_lock(&chr->chr_write_lock);
1379 pty_chr_state(chr, 0);
093d3a20
AL		 1380 fd = g_io_channel_unix_get_fd(s->fd);
1381 g_io_channel_unref(s->fd);
1382 close(fd);
8aa33caf
AL		 1383 if (s->timer_tag) {
1384 g_source_remove(s->timer_tag);
910b6368 1385 s->timer_tag = 0;
8aa33caf 1386 }
7b3621f4 1387 qemu_mutex_unlock(&chr->chr_write_lock);
7267c094 1388 g_free(s);
a425d23f 1389 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
6f97dba0
AL		 1390}
1391
e68c5958
GH		 1392static CharDriverState *qemu_chr_open_pty(const char *id,
1393 ChardevReturn *ret)
6f97dba0
AL		 1394{
1395 CharDriverState *chr;
1396 PtyCharDriver *s;
e68c5958 1397 int master_fd, slave_fd;
6f97dba0 1398 char pty_name[PATH_MAX];
6f97dba0 1399
4efeabbb
MT		 1400 master_fd = qemu_openpty_raw(&slave_fd, pty_name);
1401 if (master_fd < 0) {
1f51470d 1402 return NULL;
6f97dba0
AL		 1403 }
1404
6f97dba0 1405 close(slave_fd);
fac6688a 1406 qemu_set_nonblock(master_fd);
6f97dba0 1407
db39fcf1 1408 chr = qemu_chr_alloc();
a4e26048 1409
4efeabbb
MT		 1410 chr->filename = g_strdup_printf("pty:%s", pty_name);
1411 ret->pty = g_strdup(pty_name);
e68c5958 1412 ret->has_pty = true;
58650218 1413
e68c5958 1414 fprintf(stderr, "char device redirected to %s (label %s)\n",
4efeabbb 1415 pty_name, id);
6f97dba0 1416
2d528d45 1417 s = g_new0(PtyCharDriver, 1);
6f97dba0
AL		 1418 chr->opaque = s;
1419 chr->chr_write = pty_chr_write;
1420 chr->chr_update_read_handler = pty_chr_update_read_handler;
1421 chr->chr_close = pty_chr_close;
e6a87ed8 1422 chr->chr_add_watch = pty_chr_add_watch;
bd5c51ee 1423 chr->explicit_be_open = true;
6f97dba0 1424
093d3a20 1425 s->fd = io_channel_from_fd(master_fd);
8aa33caf 1426 s->timer_tag = 0;
6f97dba0 1427
1f51470d 1428 return chr;
6f97dba0
AL		 1429}
1430
1431static void tty_serial_init(int fd, int speed,
1432 int parity, int data_bits, int stop_bits)
1433{
1434 struct termios tty;
1435 speed_t spd;
1436
1437#if 0
1438 printf("tty_serial_init: speed=%d parity=%c data=%d stop=%d\n",
1439 speed, parity, data_bits, stop_bits);
1440#endif
1441 tcgetattr (fd, &tty);
1442
45eea13b
SW		 1443#define check_speed(val) if (speed <= val) { spd = B##val; break; }
1444 speed = speed * 10 / 11;
1445 do {
1446 check_speed(50);
1447 check_speed(75);
1448 check_speed(110);
1449 check_speed(134);
1450 check_speed(150);
1451 check_speed(200);
1452 check_speed(300);
1453 check_speed(600);
1454 check_speed(1200);
1455 check_speed(1800);
1456 check_speed(2400);
1457 check_speed(4800);
1458 check_speed(9600);
1459 check_speed(19200);
1460 check_speed(38400);
1461 /* Non-Posix values follow. They may be unsupported on some systems. */
1462 check_speed(57600);
1463 check_speed(115200);
1464#ifdef B230400
1465 check_speed(230400);
1466#endif
1467#ifdef B460800
1468 check_speed(460800);
1469#endif
1470#ifdef B500000
1471 check_speed(500000);
1472#endif
1473#ifdef B576000
1474 check_speed(576000);
1475#endif
1476#ifdef B921600
1477 check_speed(921600);
1478#endif
1479#ifdef B1000000
1480 check_speed(1000000);
1481#endif
1482#ifdef B1152000
1483 check_speed(1152000);
1484#endif
1485#ifdef B1500000
1486 check_speed(1500000);
1487#endif
1488#ifdef B2000000
1489 check_speed(2000000);
1490#endif
1491#ifdef B2500000
1492 check_speed(2500000);
1493#endif
1494#ifdef B3000000
1495 check_speed(3000000);
1496#endif
1497#ifdef B3500000
1498 check_speed(3500000);
1499#endif
1500#ifdef B4000000
1501 check_speed(4000000);
1502#endif
6f97dba0 1503 spd = B115200;
45eea13b 1504 } while (0);
6f97dba0
AL		 1505
1506 cfsetispeed(&tty, spd);
1507 cfsetospeed(&tty, spd);
1508
1509 tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
1510 |INLCR|IGNCR|ICRNL|IXON);
1511 tty.c_oflag |= OPOST;
1512 tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN|ISIG);
1513 tty.c_cflag &= ~(CSIZE|PARENB|PARODD|CRTSCTS|CSTOPB);
1514 switch(data_bits) {
1515 default:
1516 case 8:
1517 tty.c_cflag |= CS8;
1518 break;
1519 case 7:
1520 tty.c_cflag |= CS7;
1521 break;
1522 case 6:
1523 tty.c_cflag |= CS6;
1524 break;
1525 case 5:
1526 tty.c_cflag |= CS5;
1527 break;
1528 }
1529 switch(parity) {
1530 default:
1531 case 'N':
1532 break;
1533 case 'E':
1534 tty.c_cflag |= PARENB;
1535 break;
1536 case 'O':
1537 tty.c_cflag |= PARENB | PARODD;
1538 break;
1539 }
1540 if (stop_bits == 2)
1541 tty.c_cflag |= CSTOPB;
1542
1543 tcsetattr (fd, TCSANOW, &tty);
1544}
1545
1546static int tty_serial_ioctl(CharDriverState *chr, int cmd, void *arg)
1547{
1548 FDCharDriver *s = chr->opaque;
1549
1550 switch(cmd) {
1551 case CHR_IOCTL_SERIAL_SET_PARAMS:
1552 {
1553 QEMUSerialSetParams *ssp = arg;
a29753f8
AL		 1554 tty_serial_init(g_io_channel_unix_get_fd(s->fd_in),
1555 ssp->speed, ssp->parity,
6f97dba0
AL		 1556 ssp->data_bits, ssp->stop_bits);
1557 }
1558 break;
1559 case CHR_IOCTL_SERIAL_SET_BREAK:
1560 {
1561 int enable = *(int *)arg;
a29753f8
AL		 1562 if (enable) {
1563 tcsendbreak(g_io_channel_unix_get_fd(s->fd_in), 1);
1564 }
6f97dba0
AL		 1565 }
1566 break;
1567 case CHR_IOCTL_SERIAL_GET_TIOCM:
1568 {
1569 int sarg = 0;
1570 int *targ = (int *)arg;
a29753f8 1571 ioctl(g_io_channel_unix_get_fd(s->fd_in), TIOCMGET, &sarg);
6f97dba0 1572 *targ = 0;
b4abdfa4 1573 if (sarg & TIOCM_CTS)
6f97dba0 1574 *targ |= CHR_TIOCM_CTS;
b4abdfa4 1575 if (sarg & TIOCM_CAR)
6f97dba0 1576 *targ |= CHR_TIOCM_CAR;
b4abdfa4 1577 if (sarg & TIOCM_DSR)
6f97dba0 1578 *targ |= CHR_TIOCM_DSR;
b4abdfa4 1579 if (sarg & TIOCM_RI)
6f97dba0 1580 *targ |= CHR_TIOCM_RI;
b4abdfa4 1581 if (sarg & TIOCM_DTR)
6f97dba0 1582 *targ |= CHR_TIOCM_DTR;
b4abdfa4 1583 if (sarg & TIOCM_RTS)
6f97dba0
AL		 1584 *targ |= CHR_TIOCM_RTS;
1585 }
1586 break;
1587 case CHR_IOCTL_SERIAL_SET_TIOCM:
1588 {
1589 int sarg = *(int *)arg;
1590 int targ = 0;
a29753f8 1591 ioctl(g_io_channel_unix_get_fd(s->fd_in), TIOCMGET, &targ);
b4abdfa4
AJ		 1592 targ &= ~(CHR_TIOCM_CTS | CHR_TIOCM_CAR | CHR_TIOCM_DSR
1593 | CHR_TIOCM_RI | CHR_TIOCM_DTR | CHR_TIOCM_RTS);
1594 if (sarg & CHR_TIOCM_CTS)
1595 targ |= TIOCM_CTS;
1596 if (sarg & CHR_TIOCM_CAR)
1597 targ |= TIOCM_CAR;
1598 if (sarg & CHR_TIOCM_DSR)
1599 targ |= TIOCM_DSR;
1600 if (sarg & CHR_TIOCM_RI)
1601 targ |= TIOCM_RI;
1602 if (sarg & CHR_TIOCM_DTR)
6f97dba0 1603 targ |= TIOCM_DTR;
b4abdfa4 1604 if (sarg & CHR_TIOCM_RTS)
6f97dba0 1605 targ |= TIOCM_RTS;
a29753f8 1606 ioctl(g_io_channel_unix_get_fd(s->fd_in), TIOCMSET, &targ);
6f97dba0
AL		 1607 }
1608 break;
1609 default:
1610 return -ENOTSUP;
1611 }
1612 return 0;
1613}
1614
4266a134
DA		 1615static void qemu_chr_close_tty(CharDriverState *chr)
1616{
1617 FDCharDriver *s = chr->opaque;
1618 int fd = -1;
1619
1620 if (s) {
a29753f8 1621 fd = g_io_channel_unix_get_fd(s->fd_in);
4266a134
DA		 1622 }
1623
1624 fd_chr_close(chr);
1625
1626 if (fd >= 0) {
1627 close(fd);
1628 }
1629}
1630
d59044ef
GH		 1631static CharDriverState *qemu_chr_open_tty_fd(int fd)
1632{
1633 CharDriverState *chr;
1634
1635 tty_serial_init(fd, 115200, 'N', 8, 1);
1636 chr = qemu_chr_open_fd(fd, fd);
1637 chr->chr_ioctl = tty_serial_ioctl;
1638 chr->chr_close = qemu_chr_close_tty;
1639 return chr;
1640}
6f97dba0
AL		 1641#endif /* __linux__ || __sun__ */
1642
1643#if defined(__linux__)
e551498e
GH		 1644
1645#define HAVE_CHARDEV_PARPORT 1
1646
6f97dba0
AL		 1647typedef struct {
1648 int fd;
1649 int mode;
1650} ParallelCharDriver;
1651
1652static int pp_hw_mode(ParallelCharDriver *s, uint16_t mode)
1653{
1654 if (s->mode != mode) {
1655 int m = mode;
1656 if (ioctl(s->fd, PPSETMODE, &m) < 0)
1657 return 0;
1658 s->mode = mode;
1659 }
1660 return 1;
1661}
1662
1663static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
1664{
1665 ParallelCharDriver *drv = chr->opaque;
1666 int fd = drv->fd;
1667 uint8_t b;
1668
1669 switch(cmd) {
1670 case CHR_IOCTL_PP_READ_DATA:
1671 if (ioctl(fd, PPRDATA, &b) < 0)
1672 return -ENOTSUP;
1673 *(uint8_t *)arg = b;
1674 break;
1675 case CHR_IOCTL_PP_WRITE_DATA:
1676 b = *(uint8_t *)arg;
1677 if (ioctl(fd, PPWDATA, &b) < 0)
1678 return -ENOTSUP;
1679 break;
1680 case CHR_IOCTL_PP_READ_CONTROL:
1681 if (ioctl(fd, PPRCONTROL, &b) < 0)
1682 return -ENOTSUP;
1683 /* Linux gives only the lowest bits, and no way to know data
1684 direction! For better compatibility set the fixed upper
1685 bits. */
1686 *(uint8_t *)arg = b | 0xc0;
1687 break;
1688 case CHR_IOCTL_PP_WRITE_CONTROL:
1689 b = *(uint8_t *)arg;
1690 if (ioctl(fd, PPWCONTROL, &b) < 0)
1691 return -ENOTSUP;
1692 break;
1693 case CHR_IOCTL_PP_READ_STATUS:
1694 if (ioctl(fd, PPRSTATUS, &b) < 0)
1695 return -ENOTSUP;
1696 *(uint8_t *)arg = b;
1697 break;
1698 case CHR_IOCTL_PP_DATA_DIR:
1699 if (ioctl(fd, PPDATADIR, (int *)arg) < 0)
1700 return -ENOTSUP;
1701 break;
1702 case CHR_IOCTL_PP_EPP_READ_ADDR:
1703 if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
1704 struct ParallelIOArg *parg = arg;
1705 int n = read(fd, parg->buffer, parg->count);
1706 if (n != parg->count) {
1707 return -EIO;
1708 }
1709 }
1710 break;
1711 case CHR_IOCTL_PP_EPP_READ:
1712 if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
1713 struct ParallelIOArg *parg = arg;
1714 int n = read(fd, parg->buffer, parg->count);
1715 if (n != parg->count) {
1716 return -EIO;
1717 }
1718 }
1719 break;
1720 case CHR_IOCTL_PP_EPP_WRITE_ADDR:
1721 if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
1722 struct ParallelIOArg *parg = arg;
1723 int n = write(fd, parg->buffer, parg->count);
1724 if (n != parg->count) {
1725 return -EIO;
1726 }
1727 }
1728 break;
1729 case CHR_IOCTL_PP_EPP_WRITE:
1730 if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
1731 struct ParallelIOArg *parg = arg;
1732 int n = write(fd, parg->buffer, parg->count);
1733 if (n != parg->count) {
1734 return -EIO;
1735 }
1736 }
1737 break;
1738 default:
1739 return -ENOTSUP;
1740 }
1741 return 0;
1742}
1743
1744static void pp_close(CharDriverState *chr)
1745{
1746 ParallelCharDriver *drv = chr->opaque;
1747 int fd = drv->fd;
1748
1749 pp_hw_mode(drv, IEEE1284_MODE_COMPAT);
1750 ioctl(fd, PPRELEASE);
1751 close(fd);
7267c094 1752 g_free(drv);
a425d23f 1753 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
6f97dba0
AL		 1754}
1755
38bfb1a6 1756static CharDriverState *qemu_chr_open_pp_fd(int fd, Error **errp)
6f97dba0
AL		 1757{
1758 CharDriverState *chr;
1759 ParallelCharDriver *drv;
6f97dba0
AL		 1760
1761 if (ioctl(fd, PPCLAIM) < 0) {
38bfb1a6 1762 error_setg_errno(errp, errno, "not a parallel port");
6f97dba0 1763 close(fd);
1f51470d 1764 return NULL;
6f97dba0
AL		 1765 }
1766
2d528d45 1767 drv = g_new0(ParallelCharDriver, 1);
6f97dba0
AL		 1768 drv->fd = fd;
1769 drv->mode = IEEE1284_MODE_COMPAT;
1770
db39fcf1 1771 chr = qemu_chr_alloc();
6f97dba0
AL		 1772 chr->chr_write = null_chr_write;
1773 chr->chr_ioctl = pp_ioctl;
1774 chr->chr_close = pp_close;
1775 chr->opaque = drv;
1776
1f51470d 1777 return chr;
6f97dba0
AL		 1778}
1779#endif /* __linux__ */
1780
a167ba50 1781#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__DragonFly__)
e551498e
GH		 1782
1783#define HAVE_CHARDEV_PARPORT 1
1784
6972f935
BS		 1785static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
1786{
e0efb993 1787 int fd = (int)(intptr_t)chr->opaque;
6972f935
BS		 1788 uint8_t b;
1789
1790 switch(cmd) {
1791 case CHR_IOCTL_PP_READ_DATA:
1792 if (ioctl(fd, PPIGDATA, &b) < 0)
1793 return -ENOTSUP;
1794 *(uint8_t *)arg = b;
1795 break;
1796 case CHR_IOCTL_PP_WRITE_DATA:
1797 b = *(uint8_t *)arg;
1798 if (ioctl(fd, PPISDATA, &b) < 0)
1799 return -ENOTSUP;
1800 break;
1801 case CHR_IOCTL_PP_READ_CONTROL:
1802 if (ioctl(fd, PPIGCTRL, &b) < 0)
1803 return -ENOTSUP;
1804 *(uint8_t *)arg = b;
1805 break;
1806 case CHR_IOCTL_PP_WRITE_CONTROL:
1807 b = *(uint8_t *)arg;
1808 if (ioctl(fd, PPISCTRL, &b) < 0)
1809 return -ENOTSUP;
1810 break;
1811 case CHR_IOCTL_PP_READ_STATUS:
1812 if (ioctl(fd, PPIGSTATUS, &b) < 0)
1813 return -ENOTSUP;
1814 *(uint8_t *)arg = b;
1815 break;
1816 default:
1817 return -ENOTSUP;
1818 }
1819 return 0;
1820}
1821
38bfb1a6 1822static CharDriverState *qemu_chr_open_pp_fd(int fd, Error **errp)
6972f935
BS		 1823{
1824 CharDriverState *chr;
6972f935 1825
db39fcf1 1826 chr = qemu_chr_alloc();
e0efb993 1827 chr->opaque = (void *)(intptr_t)fd;
6972f935
BS		 1828 chr->chr_write = null_chr_write;
1829 chr->chr_ioctl = pp_ioctl;
bd5c51ee 1830 chr->explicit_be_open = true;
1f51470d 1831 return chr;
6972f935
BS		 1832}
1833#endif
1834
6f97dba0
AL		 1835#else /* _WIN32 */
1836
d809ab95
PB		 1837#define HAVE_CHARDEV_SERIAL 1
1838
6f97dba0
AL		 1839typedef struct {
1840 int max_size;
1841 HANDLE hcom, hrecv, hsend;
9005b2a7 1842 OVERLAPPED orecv;
6f97dba0
AL		 1843 BOOL fpipe;
1844 DWORD len;
9005b2a7
PB		 1845
1846 /* Protected by the CharDriverState chr_write_lock. */
1847 OVERLAPPED osend;
6f97dba0
AL		 1848} WinCharState;
1849
db418a0a
FC		 1850typedef struct {
1851 HANDLE hStdIn;
1852 HANDLE hInputReadyEvent;
1853 HANDLE hInputDoneEvent;
1854 HANDLE hInputThread;
1855 uint8_t win_stdio_buf;
1856} WinStdioCharState;
1857
6f97dba0
AL		 1858#define NSENDBUF 2048
1859#define NRECVBUF 2048
1860#define MAXCONNECT 1
1861#define NTIMEOUT 5000
1862
1863static int win_chr_poll(void *opaque);
1864static int win_chr_pipe_poll(void *opaque);
1865
1866static void win_chr_close(CharDriverState *chr)
1867{
1868 WinCharState *s = chr->opaque;
1869
1870 if (s->hsend) {
1871 CloseHandle(s->hsend);
1872 s->hsend = NULL;
1873 }
1874 if (s->hrecv) {
1875 CloseHandle(s->hrecv);
1876 s->hrecv = NULL;
1877 }
1878 if (s->hcom) {
1879 CloseHandle(s->hcom);
1880 s->hcom = NULL;
1881 }
1882 if (s->fpipe)
1883 qemu_del_polling_cb(win_chr_pipe_poll, chr);
1884 else
1885 qemu_del_polling_cb(win_chr_poll, chr);
793cbfb5 1886
a425d23f 1887 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
6f97dba0
AL		 1888}
1889
6511d396 1890static int win_chr_init(CharDriverState *chr, const char *filename, Error **errp)
6f97dba0
AL		 1891{
1892 WinCharState *s = chr->opaque;
1893 COMMCONFIG comcfg;
1894 COMMTIMEOUTS cto = { 0, 0, 0, 0, 0};
1895 COMSTAT comstat;
1896 DWORD size;
1897 DWORD err;
1898
1899 s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
1900 if (!s->hsend) {
6511d396 1901 error_setg(errp, "Failed CreateEvent");
6f97dba0
AL		 1902 goto fail;
1903 }
1904 s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
1905 if (!s->hrecv) {
6511d396 1906 error_setg(errp, "Failed CreateEvent");
6f97dba0
AL		 1907 goto fail;
1908 }
1909
1910 s->hcom = CreateFile(filename, GENERIC_READ|GENERIC_WRITE, 0, NULL,
1911 OPEN_EXISTING, FILE_FLAG_OVERLAPPED, 0);
1912 if (s->hcom == INVALID_HANDLE_VALUE) {
6511d396 1913 error_setg(errp, "Failed CreateFile (%lu)", GetLastError());
6f97dba0
AL		 1914 s->hcom = NULL;
1915 goto fail;
1916 }
1917
1918 if (!SetupComm(s->hcom, NRECVBUF, NSENDBUF)) {
6511d396 1919 error_setg(errp, "Failed SetupComm");
6f97dba0
AL		 1920 goto fail;
1921 }
1922
1923 ZeroMemory(&comcfg, sizeof(COMMCONFIG));
1924 size = sizeof(COMMCONFIG);
1925 GetDefaultCommConfig(filename, &comcfg, &size);
1926 comcfg.dcb.DCBlength = sizeof(DCB);
1927 CommConfigDialog(filename, NULL, &comcfg);
1928
1929 if (!SetCommState(s->hcom, &comcfg.dcb)) {
6511d396 1930 error_setg(errp, "Failed SetCommState");
6f97dba0
AL		 1931 goto fail;
1932 }
1933
1934 if (!SetCommMask(s->hcom, EV_ERR)) {
6511d396 1935 error_setg(errp, "Failed SetCommMask");
6f97dba0
AL		 1936 goto fail;
1937 }
1938
1939 cto.ReadIntervalTimeout = MAXDWORD;
1940 if (!SetCommTimeouts(s->hcom, &cto)) {
6511d396 1941 error_setg(errp, "Failed SetCommTimeouts");
6f97dba0
AL		 1942 goto fail;
1943 }
1944
1945 if (!ClearCommError(s->hcom, &err, &comstat)) {
6511d396 1946 error_setg(errp, "Failed ClearCommError");
6f97dba0
AL		 1947 goto fail;
1948 }
1949 qemu_add_polling_cb(win_chr_poll, chr);
1950 return 0;
1951
1952 fail:
1953 win_chr_close(chr);
1954 return -1;
1955}
1956
9005b2a7 1957/* Called with chr_write_lock held. */
6f97dba0
AL		 1958static int win_chr_write(CharDriverState *chr, const uint8_t *buf, int len1)
1959{
1960 WinCharState *s = chr->opaque;
1961 DWORD len, ret, size, err;
1962
1963 len = len1;
1964 ZeroMemory(&s->osend, sizeof(s->osend));
1965 s->osend.hEvent = s->hsend;
1966 while (len > 0) {
1967 if (s->hsend)
1968 ret = WriteFile(s->hcom, buf, len, &size, &s->osend);
1969 else
1970 ret = WriteFile(s->hcom, buf, len, &size, NULL);
1971 if (!ret) {
1972 err = GetLastError();
1973 if (err == ERROR_IO_PENDING) {
1974 ret = GetOverlappedResult(s->hcom, &s->osend, &size, TRUE);
1975 if (ret) {
1976 buf += size;
1977 len -= size;
1978 } else {
1979 break;
1980 }
1981 } else {
1982 break;
1983 }
1984 } else {
1985 buf += size;
1986 len -= size;
1987 }
1988 }
1989 return len1 - len;
1990}
1991
1992static int win_chr_read_poll(CharDriverState *chr)
1993{
1994 WinCharState *s = chr->opaque;
1995
909cda12 1996 s->max_size = qemu_chr_be_can_write(chr);
6f97dba0
AL		 1997 return s->max_size;
1998}
1999
2000static void win_chr_readfile(CharDriverState *chr)
2001{
2002 WinCharState *s = chr->opaque;
2003 int ret, err;
9bd7854e 2004 uint8_t buf[READ_BUF_LEN];
6f97dba0
AL		 2005 DWORD size;
2006
2007 ZeroMemory(&s->orecv, sizeof(s->orecv));
2008 s->orecv.hEvent = s->hrecv;
2009 ret = ReadFile(s->hcom, buf, s->len, &size, &s->orecv);
2010 if (!ret) {
2011 err = GetLastError();
2012 if (err == ERROR_IO_PENDING) {
2013 ret = GetOverlappedResult(s->hcom, &s->orecv, &size, TRUE);
2014 }
2015 }
2016
2017 if (size > 0) {
fa5efccb 2018 qemu_chr_be_write(chr, buf, size);
6f97dba0
AL		 2019 }
2020}
2021
2022static void win_chr_read(CharDriverState *chr)
2023{
2024 WinCharState *s = chr->opaque;
2025
2026 if (s->len > s->max_size)
2027 s->len = s->max_size;
2028 if (s->len == 0)
2029 return;
2030
2031 win_chr_readfile(chr);
2032}
2033
2034static int win_chr_poll(void *opaque)
2035{
2036 CharDriverState *chr = opaque;
2037 WinCharState *s = chr->opaque;
2038 COMSTAT status;
2039 DWORD comerr;
2040
2041 ClearCommError(s->hcom, &comerr, &status);
2042 if (status.cbInQue > 0) {
2043 s->len = status.cbInQue;
2044 win_chr_read_poll(chr);
2045 win_chr_read(chr);
2046 return 1;
2047 }
2048 return 0;
2049}
2050
6511d396
PB		 2051static CharDriverState *qemu_chr_open_win_path(const char *filename,
2052 Error **errp)
6f97dba0
AL		 2053{
2054 CharDriverState *chr;
2055 WinCharState *s;
2056
db39fcf1 2057 chr = qemu_chr_alloc();
2d528d45 2058 s = g_new0(WinCharState, 1);
6f97dba0
AL		 2059 chr->opaque = s;
2060 chr->chr_write = win_chr_write;
2061 chr->chr_close = win_chr_close;
2062
6511d396 2063 if (win_chr_init(chr, filename, errp) < 0) {
2e02e18b
SW		 2064 g_free(s);
2065 g_free(chr);
1f51470d 2066 return NULL;
6f97dba0 2067 }
1f51470d 2068 return chr;
6f97dba0
AL		 2069}
2070
2071static int win_chr_pipe_poll(void *opaque)
2072{
2073 CharDriverState *chr = opaque;
2074 WinCharState *s = chr->opaque;
2075 DWORD size;
2076
2077 PeekNamedPipe(s->hcom, NULL, 0, NULL, &size, NULL);
2078 if (size > 0) {
2079 s->len = size;
2080 win_chr_read_poll(chr);
2081 win_chr_read(chr);
2082 return 1;
2083 }
2084 return 0;
2085}
2086
20cbe7a2
PB		 2087static int win_chr_pipe_init(CharDriverState *chr, const char *filename,
2088 Error **errp)
6f97dba0
AL		 2089{
2090 WinCharState *s = chr->opaque;
2091 OVERLAPPED ov;
2092 int ret;
2093 DWORD size;
9f781168 2094 char openname[CHR_MAX_FILENAME_SIZE];
6f97dba0
AL		 2095
2096 s->fpipe = TRUE;
2097
2098 s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
2099 if (!s->hsend) {
20cbe7a2 2100 error_setg(errp, "Failed CreateEvent");
6f97dba0
AL		 2101 goto fail;
2102 }
2103 s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
2104 if (!s->hrecv) {
20cbe7a2 2105 error_setg(errp, "Failed CreateEvent");
6f97dba0
AL		 2106 goto fail;
2107 }
2108
2109 snprintf(openname, sizeof(openname), "\\\\.\\pipe\\%s", filename);
2110 s->hcom = CreateNamedPipe(openname, PIPE_ACCESS_DUPLEX | FILE_FLAG_OVERLAPPED,
2111 PIPE_TYPE_BYTE | PIPE_READMODE_BYTE |
2112 PIPE_WAIT,
2113 MAXCONNECT, NSENDBUF, NRECVBUF, NTIMEOUT, NULL);
2114 if (s->hcom == INVALID_HANDLE_VALUE) {
20cbe7a2 2115 error_setg(errp, "Failed CreateNamedPipe (%lu)", GetLastError());
6f97dba0
AL		 2116 s->hcom = NULL;
2117 goto fail;
2118 }
2119
2120 ZeroMemory(&ov, sizeof(ov));
2121 ov.hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
2122 ret = ConnectNamedPipe(s->hcom, &ov);
2123 if (ret) {
20cbe7a2 2124 error_setg(errp, "Failed ConnectNamedPipe");
6f97dba0
AL		 2125 goto fail;
2126 }
2127
2128 ret = GetOverlappedResult(s->hcom, &ov, &size, TRUE);
2129 if (!ret) {
20cbe7a2 2130 error_setg(errp, "Failed GetOverlappedResult");
6f97dba0
AL		 2131 if (ov.hEvent) {
2132 CloseHandle(ov.hEvent);
2133 ov.hEvent = NULL;
2134 }
2135 goto fail;
2136 }
2137
2138 if (ov.hEvent) {
2139 CloseHandle(ov.hEvent);
2140 ov.hEvent = NULL;
2141 }
2142 qemu_add_polling_cb(win_chr_pipe_poll, chr);
2143 return 0;
2144
2145 fail:
2146 win_chr_close(chr);
2147 return -1;
2148}
2149
2150
20cbe7a2
PB		 2151static CharDriverState *qemu_chr_open_pipe(const char *id,
2152 ChardevBackend *backend,
2153 ChardevReturn *ret,
2154 Error **errp)
6f97dba0 2155{
20cbe7a2 2156 ChardevHostdev *opts = backend->pipe;
548cbb36 2157 const char *filename = opts->device;
6f97dba0
AL		 2158 CharDriverState *chr;
2159 WinCharState *s;
2160
db39fcf1 2161 chr = qemu_chr_alloc();
2d528d45 2162 s = g_new0(WinCharState, 1);
6f97dba0
AL		 2163 chr->opaque = s;
2164 chr->chr_write = win_chr_write;
2165 chr->chr_close = win_chr_close;
2166
20cbe7a2 2167 if (win_chr_pipe_init(chr, filename, errp) < 0) {
2e02e18b
SW		 2168 g_free(s);
2169 g_free(chr);
1f51470d 2170 return NULL;
6f97dba0 2171 }
1f51470d 2172 return chr;
6f97dba0
AL		 2173}
2174
1f51470d 2175static CharDriverState *qemu_chr_open_win_file(HANDLE fd_out)
6f97dba0
AL		 2176{
2177 CharDriverState *chr;
2178 WinCharState *s;
2179
db39fcf1 2180 chr = qemu_chr_alloc();
2d528d45 2181 s = g_new0(WinCharState, 1);
6f97dba0
AL		 2182 s->hcom = fd_out;
2183 chr->opaque = s;
2184 chr->chr_write = win_chr_write;
1f51470d 2185 return chr;
6f97dba0
AL		 2186}
2187
d9ac374f 2188static CharDriverState *qemu_chr_open_win_con(void)
6f97dba0 2189{
1f51470d 2190 return qemu_chr_open_win_file(GetStdHandle(STD_OUTPUT_HANDLE));
6f97dba0
AL		 2191}
2192
db418a0a
FC		 2193static int win_stdio_write(CharDriverState *chr, const uint8_t *buf, int len)
2194{
2195 HANDLE hStdOut = GetStdHandle(STD_OUTPUT_HANDLE);
2196 DWORD dwSize;
2197 int len1;
2198
2199 len1 = len;
2200
2201 while (len1 > 0) {
2202 if (!WriteFile(hStdOut, buf, len1, &dwSize, NULL)) {
2203 break;
2204 }
2205 buf += dwSize;
2206 len1 -= dwSize;
2207 }
2208
2209 return len - len1;
2210}
2211
2212static void win_stdio_wait_func(void *opaque)
2213{
2214 CharDriverState *chr = opaque;
2215 WinStdioCharState *stdio = chr->opaque;
2216 INPUT_RECORD buf[4];
2217 int ret;
2218 DWORD dwSize;
2219 int i;
2220
dff7424d 2221 ret = ReadConsoleInput(stdio->hStdIn, buf, ARRAY_SIZE(buf), &dwSize);
db418a0a
FC		 2222
2223 if (!ret) {
2224 /* Avoid error storm */
2225 qemu_del_wait_object(stdio->hStdIn, NULL, NULL);
2226 return;
2227 }
2228
2229 for (i = 0; i < dwSize; i++) {
2230 KEY_EVENT_RECORD *kev = &buf[i].Event.KeyEvent;
2231
2232 if (buf[i].EventType == KEY_EVENT && kev->bKeyDown) {
2233 int j;
2234 if (kev->uChar.AsciiChar != 0) {
2235 for (j = 0; j < kev->wRepeatCount; j++) {
2236 if (qemu_chr_be_can_write(chr)) {
2237 uint8_t c = kev->uChar.AsciiChar;
2238 qemu_chr_be_write(chr, &c, 1);
2239 }
2240 }
2241 }
2242 }
2243 }
2244}
2245
2246static DWORD WINAPI win_stdio_thread(LPVOID param)
2247{
2248 CharDriverState *chr = param;
2249 WinStdioCharState *stdio = chr->opaque;
2250 int ret;
2251 DWORD dwSize;
2252
2253 while (1) {
2254
2255 /* Wait for one byte */
2256 ret = ReadFile(stdio->hStdIn, &stdio->win_stdio_buf, 1, &dwSize, NULL);
2257
2258 /* Exit in case of error, continue if nothing read */
2259 if (!ret) {
2260 break;
2261 }
2262 if (!dwSize) {
2263 continue;
2264 }
2265
2266 /* Some terminal emulator returns \r\n for Enter, just pass \n */
2267 if (stdio->win_stdio_buf == '\r') {
2268 continue;
2269 }
2270
2271 /* Signal the main thread and wait until the byte was eaten */
2272 if (!SetEvent(stdio->hInputReadyEvent)) {
2273 break;
2274 }
2275 if (WaitForSingleObject(stdio->hInputDoneEvent, INFINITE)
2276 != WAIT_OBJECT_0) {
2277 break;
2278 }
2279 }
2280
2281 qemu_del_wait_object(stdio->hInputReadyEvent, NULL, NULL);
2282 return 0;
2283}
2284
2285static void win_stdio_thread_wait_func(void *opaque)
2286{
2287 CharDriverState *chr = opaque;
2288 WinStdioCharState *stdio = chr->opaque;
2289
2290 if (qemu_chr_be_can_write(chr)) {
2291 qemu_chr_be_write(chr, &stdio->win_stdio_buf, 1);
2292 }
2293
2294 SetEvent(stdio->hInputDoneEvent);
2295}
2296
2297static void qemu_chr_set_echo_win_stdio(CharDriverState *chr, bool echo)
2298{
2299 WinStdioCharState *stdio = chr->opaque;
2300 DWORD dwMode = 0;
2301
2302 GetConsoleMode(stdio->hStdIn, &dwMode);
2303
2304 if (echo) {
2305 SetConsoleMode(stdio->hStdIn, dwMode | ENABLE_ECHO_INPUT);
2306 } else {
2307 SetConsoleMode(stdio->hStdIn, dwMode & ~ENABLE_ECHO_INPUT);
2308 }
2309}
2310
2311static void win_stdio_close(CharDriverState *chr)
2312{
2313 WinStdioCharState *stdio = chr->opaque;
2314
2315 if (stdio->hInputReadyEvent != INVALID_HANDLE_VALUE) {
2316 CloseHandle(stdio->hInputReadyEvent);
2317 }
2318 if (stdio->hInputDoneEvent != INVALID_HANDLE_VALUE) {
2319 CloseHandle(stdio->hInputDoneEvent);
2320 }
2321 if (stdio->hInputThread != INVALID_HANDLE_VALUE) {
2322 TerminateThread(stdio->hInputThread, 0);
2323 }
2324
2325 g_free(chr->opaque);
2326 g_free(chr);
db418a0a
FC		 2327}
2328
7c358031 2329static CharDriverState *qemu_chr_open_stdio(ChardevStdio *opts)
db418a0a
FC		 2330{
2331 CharDriverState *chr;
2332 WinStdioCharState *stdio;
2333 DWORD dwMode;
2334 int is_console = 0;
2335
db39fcf1 2336 chr = qemu_chr_alloc();
2d528d45 2337 stdio = g_new0(WinStdioCharState, 1);
db418a0a
FC		 2338
2339 stdio->hStdIn = GetStdHandle(STD_INPUT_HANDLE);
2340 if (stdio->hStdIn == INVALID_HANDLE_VALUE) {
2341 fprintf(stderr, "cannot open stdio: invalid handle\n");
2342 exit(1);
2343 }
2344
2345 is_console = GetConsoleMode(stdio->hStdIn, &dwMode) != 0;
2346
2347 chr->opaque = stdio;
2348 chr->chr_write = win_stdio_write;
2349 chr->chr_close = win_stdio_close;
2350
ed7a1540
AL		 2351 if (is_console) {
2352 if (qemu_add_wait_object(stdio->hStdIn,
2353 win_stdio_wait_func, chr)) {
2354 fprintf(stderr, "qemu_add_wait_object: failed\n");
2355 }
2356 } else {
2357 DWORD dwId;
2358
2359 stdio->hInputReadyEvent = CreateEvent(NULL, FALSE, FALSE, NULL);
2360 stdio->hInputDoneEvent = CreateEvent(NULL, FALSE, FALSE, NULL);
2361 stdio->hInputThread = CreateThread(NULL, 0, win_stdio_thread,
2362 chr, 0, &dwId);
2363
2364 if (stdio->hInputThread == INVALID_HANDLE_VALUE
2365 || stdio->hInputReadyEvent == INVALID_HANDLE_VALUE
2366 || stdio->hInputDoneEvent == INVALID_HANDLE_VALUE) {
2367 fprintf(stderr, "cannot create stdio thread or event\n");
2368 exit(1);
2369 }
2370 if (qemu_add_wait_object(stdio->hInputReadyEvent,
2371 win_stdio_thread_wait_func, chr)) {
2372 fprintf(stderr, "qemu_add_wait_object: failed\n");
db418a0a
FC		 2373 }
2374 }
2375
2376 dwMode |= ENABLE_LINE_INPUT;
2377
ed7a1540 2378 if (is_console) {
db418a0a
FC		 2379 /* set the terminal in raw mode */
2380 /* ENABLE_QUICK_EDIT_MODE | ENABLE_EXTENDED_FLAGS */
2381 dwMode |= ENABLE_PROCESSED_INPUT;
2382 }
2383
2384 SetConsoleMode(stdio->hStdIn, dwMode);
2385
2386 chr->chr_set_echo = qemu_chr_set_echo_win_stdio;
2387 qemu_chr_fe_set_echo(chr, false);
2388
1f51470d 2389 return chr;
db418a0a 2390}
6f97dba0
AL		 2391#endif /* !_WIN32 */
2392
5ab8211b 2393
6f97dba0
AL		 2394/***********************************************************/
2395/* UDP Net console */
2396
2397typedef struct {
2398 int fd;
76a9644b 2399 GIOChannel *chan;
9bd7854e 2400 uint8_t buf[READ_BUF_LEN];
6f97dba0
AL		 2401 int bufcnt;
2402 int bufptr;
2403 int max_size;
2404} NetCharDriver;
2405
9005b2a7 2406/* Called with chr_write_lock held. */
6f97dba0
AL		 2407static int udp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2408{
2409 NetCharDriver *s = chr->opaque;
76a9644b
AL		 2410 gsize bytes_written;
2411 GIOStatus status;
2412
2413 status = g_io_channel_write_chars(s->chan, (const gchar *)buf, len, &bytes_written, NULL);
2414 if (status == G_IO_STATUS_EOF) {
2415 return 0;
2416 } else if (status != G_IO_STATUS_NORMAL) {
2417 return -1;
2418 }
6f97dba0 2419
76a9644b 2420 return bytes_written;
6f97dba0
AL		 2421}
2422
2423static int udp_chr_read_poll(void *opaque)
2424{
2425 CharDriverState *chr = opaque;
2426 NetCharDriver *s = chr->opaque;
2427
909cda12 2428 s->max_size = qemu_chr_be_can_write(chr);
6f97dba0
AL		 2429
2430 /* If there were any stray characters in the queue process them
2431 * first
2432 */
2433 while (s->max_size > 0 && s->bufptr < s->bufcnt) {
fa5efccb 2434 qemu_chr_be_write(chr, &s->buf[s->bufptr], 1);
6f97dba0 2435 s->bufptr++;
909cda12 2436 s->max_size = qemu_chr_be_can_write(chr);
6f97dba0
AL		 2437 }
2438 return s->max_size;
2439}
2440
76a9644b 2441static gboolean udp_chr_read(GIOChannel *chan, GIOCondition cond, void *opaque)
6f97dba0
AL		 2442{
2443 CharDriverState *chr = opaque;
2444 NetCharDriver *s = chr->opaque;
76a9644b
AL		 2445 gsize bytes_read = 0;
2446 GIOStatus status;
6f97dba0 2447
cdbf6e16
PB		 2448 if (s->max_size == 0) {
2449 return TRUE;
2450 }
76a9644b
AL		 2451 status = g_io_channel_read_chars(s->chan, (gchar *)s->buf, sizeof(s->buf),
2452 &bytes_read, NULL);
2453 s->bufcnt = bytes_read;
6f97dba0 2454 s->bufptr = s->bufcnt;
76a9644b 2455 if (status != G_IO_STATUS_NORMAL) {
26da70c7 2456 remove_fd_in_watch(chr);
76a9644b
AL		 2457 return FALSE;
2458 }
6f97dba0
AL		 2459
2460 s->bufptr = 0;
2461 while (s->max_size > 0 && s->bufptr < s->bufcnt) {
fa5efccb 2462 qemu_chr_be_write(chr, &s->buf[s->bufptr], 1);
6f97dba0 2463 s->bufptr++;
909cda12 2464 s->max_size = qemu_chr_be_can_write(chr);
6f97dba0 2465 }
76a9644b
AL		 2466
2467 return TRUE;
6f97dba0
AL		 2468}
2469
2470static void udp_chr_update_read_handler(CharDriverState *chr)
2471{
2472 NetCharDriver *s = chr->opaque;
2473
26da70c7 2474 remove_fd_in_watch(chr);
76a9644b 2475 if (s->chan) {
7ba9addc
AS		 2476 chr->fd_in_tag = io_add_watch_poll(s->chan, udp_chr_read_poll,
2477 udp_chr_read, chr);
6f97dba0
AL		 2478 }
2479}
2480
819f56b7
AL		 2481static void udp_chr_close(CharDriverState *chr)
2482{
2483 NetCharDriver *s = chr->opaque;
26da70c7
AS		 2484
2485 remove_fd_in_watch(chr);
76a9644b
AL		 2486 if (s->chan) {
2487 g_io_channel_unref(s->chan);
819f56b7
AL		 2488 closesocket(s->fd);
2489 }
7267c094 2490 g_free(s);
a425d23f 2491 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
819f56b7
AL		 2492}
2493
3ecc059d 2494static CharDriverState *qemu_chr_open_udp_fd(int fd)
6f97dba0
AL		 2495{
2496 CharDriverState *chr = NULL;
2497 NetCharDriver *s = NULL;
6f97dba0 2498
db39fcf1 2499 chr = qemu_chr_alloc();
2d528d45 2500 s = g_new0(NetCharDriver, 1);
6f97dba0 2501
6f97dba0 2502 s->fd = fd;
76a9644b 2503 s->chan = io_channel_from_socket(s->fd);
6f97dba0
AL		 2504 s->bufcnt = 0;
2505 s->bufptr = 0;
2506 chr->opaque = s;
2507 chr->chr_write = udp_chr_write;
2508 chr->chr_update_read_handler = udp_chr_update_read_handler;
819f56b7 2509 chr->chr_close = udp_chr_close;
bd5c51ee
MR		 2510 /* be isn't opened until we get a connection */
2511 chr->explicit_be_open = true;
1f51470d 2512 return chr;
3ecc059d 2513}
6f97dba0 2514
6f97dba0
AL		 2515/***********************************************************/
2516/* TCP Net console */
2517
2518typedef struct {
2ea5a7af
AL		 2519
2520 GIOChannel *chan, *listen_chan;
7ba9addc 2521 guint listen_tag;
6f97dba0
AL		 2522 int fd, listen_fd;
2523 int connected;
2524 int max_size;
2525 int do_telnetopt;
2526 int do_nodelay;
2527 int is_unix;
c76bf6bb
NN		 2528 int *read_msgfds;
2529 int read_msgfds_num;
d39aac7a
NN		 2530 int *write_msgfds;
2531 int write_msgfds_num;
cfb429cb
CM		 2532
2533 SocketAddress *addr;
2534 bool is_listen;
2535 bool is_telnet;
5dd1f02b
CM		 2536
2537 guint reconnect_timer;
2538 int64_t reconnect_time;
5008e5b7 2539 bool connect_err_reported;
6f97dba0
AL		 2540} TCPCharDriver;
2541
5dd1f02b
CM		 2542static gboolean socket_reconnect_timeout(gpointer opaque);
2543
2544static void qemu_chr_socket_restart_timer(CharDriverState *chr)
2545{
2546 TCPCharDriver *s = chr->opaque;
2547 assert(s->connected == 0);
2548 s->reconnect_timer = g_timeout_add_seconds(s->reconnect_time,
2549 socket_reconnect_timeout, chr);
2550}
2551
5008e5b7
CM		 2552static void check_report_connect_error(CharDriverState *chr,
2553 Error *err)
2554{
2555 TCPCharDriver *s = chr->opaque;
2556
2557 if (!s->connect_err_reported) {
2558 error_report("Unable to connect character device %s: %s",
2559 chr->label, error_get_pretty(err));
2560 s->connect_err_reported = true;
2561 }
2562 qemu_chr_socket_restart_timer(chr);
2563}
2564
2ea5a7af 2565static gboolean tcp_chr_accept(GIOChannel *chan, GIOCondition cond, void *opaque);
6f97dba0 2566
d39aac7a
NN		 2567#ifndef _WIN32
2568static int unix_send_msgfds(CharDriverState *chr, const uint8_t *buf, int len)
2569{
2570 TCPCharDriver *s = chr->opaque;
2571 struct msghdr msgh;
2572 struct iovec iov;
2573 int r;
2574
2575 size_t fd_size = s->write_msgfds_num * sizeof(int);
2576 char control[CMSG_SPACE(fd_size)];
2577 struct cmsghdr *cmsg;
2578
2579 memset(&msgh, 0, sizeof(msgh));
2580 memset(control, 0, sizeof(control));
2581
2582 /* set the payload */
2583 iov.iov_base = (uint8_t *) buf;
2584 iov.iov_len = len;
2585
2586 msgh.msg_iov = &iov;
2587 msgh.msg_iovlen = 1;
2588
2589 msgh.msg_control = control;
2590 msgh.msg_controllen = sizeof(control);
2591
2592 cmsg = CMSG_FIRSTHDR(&msgh);
2593
2594 cmsg->cmsg_len = CMSG_LEN(fd_size);
2595 cmsg->cmsg_level = SOL_SOCKET;
2596 cmsg->cmsg_type = SCM_RIGHTS;
2597 memcpy(CMSG_DATA(cmsg), s->write_msgfds, fd_size);
2598
2599 do {
2600 r = sendmsg(s->fd, &msgh, 0);
2601 } while (r < 0 && errno == EINTR);
2602
2603 /* free the written msgfds, no matter what */
2604 if (s->write_msgfds_num) {
2605 g_free(s->write_msgfds);
2606 s->write_msgfds = 0;
2607 s->write_msgfds_num = 0;
2608 }
2609
2610 return r;
2611}
2612#endif
2613
9005b2a7 2614/* Called with chr_write_lock held. */
6f97dba0
AL		 2615static int tcp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2616{
2617 TCPCharDriver *s = chr->opaque;
2618 if (s->connected) {
d39aac7a
NN		 2619#ifndef _WIN32
2620 if (s->is_unix && s->write_msgfds_num) {
2621 return unix_send_msgfds(chr, buf, len);
2622 } else
2623#endif
2624 {
2625 return io_channel_send(s->chan, buf, len);
2626 }
455aa1e0 2627 } else {
6db0fdce 2628 /* XXX: indicate an error ? */
455aa1e0 2629 return len;
6f97dba0
AL		 2630 }
2631}
2632
2633static int tcp_chr_read_poll(void *opaque)
2634{
2635 CharDriverState *chr = opaque;
2636 TCPCharDriver *s = chr->opaque;
2637 if (!s->connected)
2638 return 0;
909cda12 2639 s->max_size = qemu_chr_be_can_write(chr);
6f97dba0
AL		 2640 return s->max_size;
2641}
2642
2643#define IAC 255
2644#define IAC_BREAK 243
2645static void tcp_chr_process_IAC_bytes(CharDriverState *chr,
2646 TCPCharDriver *s,
2647 uint8_t *buf, int *size)
2648{
2649 /* Handle any telnet client's basic IAC options to satisfy char by
2650 * char mode with no echo. All IAC options will be removed from
2651 * the buf and the do_telnetopt variable will be used to track the
2652 * state of the width of the IAC information.
2653 *
2654 * IAC commands come in sets of 3 bytes with the exception of the
2655 * "IAC BREAK" command and the double IAC.
2656 */
2657
2658 int i;
2659 int j = 0;
2660
2661 for (i = 0; i < *size; i++) {
2662 if (s->do_telnetopt > 1) {
2663 if ((unsigned char)buf[i] == IAC && s->do_telnetopt == 2) {
2664 /* Double IAC means send an IAC */
2665 if (j != i)
2666 buf[j] = buf[i];
2667 j++;
2668 s->do_telnetopt = 1;
2669 } else {
2670 if ((unsigned char)buf[i] == IAC_BREAK && s->do_telnetopt == 2) {
2671 /* Handle IAC break commands by sending a serial break */
a425d23f 2672 qemu_chr_be_event(chr, CHR_EVENT_BREAK);
6f97dba0
AL		 2673 s->do_telnetopt++;
2674 }
2675 s->do_telnetopt++;
2676 }
2677 if (s->do_telnetopt >= 4) {
2678 s->do_telnetopt = 1;
2679 }
2680 } else {
2681 if ((unsigned char)buf[i] == IAC) {
2682 s->do_telnetopt = 2;
2683 } else {
2684 if (j != i)
2685 buf[j] = buf[i];
2686 j++;
2687 }
2688 }
2689 }
2690 *size = j;
2691}
2692
c76bf6bb 2693static int tcp_get_msgfds(CharDriverState *chr, int *fds, int num)
7d174059
MM		 2694{
2695 TCPCharDriver *s = chr->opaque;
c76bf6bb
NN		 2696 int to_copy = (s->read_msgfds_num < num) ? s->read_msgfds_num : num;
2697
c4095726
MT		 2698 assert(num <= TCP_MAX_FDS);
2699
c76bf6bb 2700 if (to_copy) {
d2fc39b4
SH		 2701 int i;
2702
c76bf6bb
NN		 2703 memcpy(fds, s->read_msgfds, to_copy * sizeof(int));
2704
d2fc39b4
SH		 2705 /* Close unused fds */
2706 for (i = to_copy; i < s->read_msgfds_num; i++) {
2707 close(s->read_msgfds[i]);
2708 }
2709
c76bf6bb
NN		 2710 g_free(s->read_msgfds);
2711 s->read_msgfds = 0;
2712 s->read_msgfds_num = 0;
2713 }
2714
2715 return to_copy;
7d174059
MM		 2716}
2717
d39aac7a
NN		 2718static int tcp_set_msgfds(CharDriverState *chr, int *fds, int num)
2719{
2720 TCPCharDriver *s = chr->opaque;
2721
2722 /* clear old pending fd array */
ef1e1e07 2723 g_free(s->write_msgfds);
d39aac7a
NN		 2724
2725 if (num) {
2d528d45 2726 s->write_msgfds = g_new(int, num);
d39aac7a
NN		 2727 memcpy(s->write_msgfds, fds, num * sizeof(int));
2728 }
2729
2730 s->write_msgfds_num = num;
2731
2732 return 0;
2733}
2734
73bcc2ac 2735#ifndef _WIN32
7d174059
MM		 2736static void unix_process_msgfd(CharDriverState *chr, struct msghdr *msg)
2737{
2738 TCPCharDriver *s = chr->opaque;
2739 struct cmsghdr *cmsg;
2740
2741 for (cmsg = CMSG_FIRSTHDR(msg); cmsg; cmsg = CMSG_NXTHDR(msg, cmsg)) {
c76bf6bb 2742 int fd_size, i;
7d174059 2743
c76bf6bb 2744 if (cmsg->cmsg_len < CMSG_LEN(sizeof(int)) ||
7d174059 2745 cmsg->cmsg_level != SOL_SOCKET ||
c76bf6bb 2746 cmsg->cmsg_type != SCM_RIGHTS) {
7d174059 2747 continue;
c76bf6bb 2748 }
7d174059 2749
c76bf6bb
NN		 2750 fd_size = cmsg->cmsg_len - CMSG_LEN(0);
2751
2752 if (!fd_size) {
7d174059 2753 continue;
c76bf6bb 2754 }
7d174059 2755
c76bf6bb
NN		 2756 /* close and clean read_msgfds */
2757 for (i = 0; i < s->read_msgfds_num; i++) {
2758 close(s->read_msgfds[i]);
2759 }
9b938c72 2760
c76bf6bb
NN		 2761 if (s->read_msgfds_num) {
2762 g_free(s->read_msgfds);
2763 }
2764
2765 s->read_msgfds_num = fd_size / sizeof(int);
2766 s->read_msgfds = g_malloc(fd_size);
2767 memcpy(s->read_msgfds, CMSG_DATA(cmsg), fd_size);
2768
2769 for (i = 0; i < s->read_msgfds_num; i++) {
2770 int fd = s->read_msgfds[i];
2771 if (fd < 0) {
2772 continue;
2773 }
2774
2775 /* O_NONBLOCK is preserved across SCM_RIGHTS so reset it */
2776 qemu_set_block(fd);
2777
2778 #ifndef MSG_CMSG_CLOEXEC
2779 qemu_set_cloexec(fd);
2780 #endif
2781 }
7d174059
MM		 2782 }
2783}
2784
9977c894
MM		 2785static ssize_t tcp_chr_recv(CharDriverState *chr, char *buf, size_t len)
2786{
2787 TCPCharDriver *s = chr->opaque;
7cba04f6 2788 struct msghdr msg = { NULL, };
9977c894 2789 struct iovec iov[1];
7d174059
MM		 2790 union {
2791 struct cmsghdr cmsg;
c4095726 2792 char control[CMSG_SPACE(sizeof(int) * TCP_MAX_FDS)];
7d174059 2793 } msg_control;
06138651 2794 int flags = 0;
7d174059 2795 ssize_t ret;
9977c894
MM		 2796
2797 iov[0].iov_base = buf;
2798 iov[0].iov_len = len;
2799
2800 msg.msg_iov = iov;
2801 msg.msg_iovlen = 1;
7d174059
MM		 2802 msg.msg_control = &msg_control;
2803 msg.msg_controllen = sizeof(msg_control);
2804
06138651
CB		 2805#ifdef MSG_CMSG_CLOEXEC
2806 flags |= MSG_CMSG_CLOEXEC;
2807#endif
9172f428
PB		 2808 do {
2809 ret = recvmsg(s->fd, &msg, flags);
2810 } while (ret == -1 && errno == EINTR);
2811
06138651 2812 if (ret > 0 && s->is_unix) {
7d174059 2813 unix_process_msgfd(chr, &msg);
06138651 2814 }
9977c894 2815
7d174059 2816 return ret;
9977c894
MM		 2817}
2818#else
2819static ssize_t tcp_chr_recv(CharDriverState *chr, char *buf, size_t len)
2820{
2821 TCPCharDriver *s = chr->opaque;
9172f428
PB		 2822 ssize_t ret;
2823
2824 do {
2825 ret = qemu_recv(s->fd, buf, len, 0);
2826 } while (ret == -1 && socket_error() == EINTR);
2827
2828 return ret;
9977c894
MM		 2829}
2830#endif
2831
d3cc5bc4
AS		 2832static GSource *tcp_chr_add_watch(CharDriverState *chr, GIOCondition cond)
2833{
2834 TCPCharDriver *s = chr->opaque;
2835 return g_io_create_watch(s->chan, cond);
2836}
2837
7b0bfdf5
NN		 2838static void tcp_chr_disconnect(CharDriverState *chr)
2839{
2840 TCPCharDriver *s = chr->opaque;
2841
2842 s->connected = 0;
2843 if (s->listen_chan) {
2844 s->listen_tag = g_io_add_watch(s->listen_chan, G_IO_IN,
2845 tcp_chr_accept, chr);
2846 }
2847 remove_fd_in_watch(chr);
2848 g_io_channel_unref(s->chan);
2849 s->chan = NULL;
2850 closesocket(s->fd);
2851 s->fd = -1;
16cc4ffe
CM		 2852 SocketAddress_to_str(chr->filename, CHR_MAX_FILENAME_SIZE,
2853 "disconnected:", s->addr, s->is_listen, s->is_telnet);
7b0bfdf5 2854 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
5dd1f02b
CM		 2855 if (s->reconnect_time) {
2856 qemu_chr_socket_restart_timer(chr);
2857 }
7b0bfdf5
NN		 2858}
2859
2ea5a7af 2860static gboolean tcp_chr_read(GIOChannel *chan, GIOCondition cond, void *opaque)
6f97dba0
AL		 2861{
2862 CharDriverState *chr = opaque;
2863 TCPCharDriver *s = chr->opaque;
9bd7854e 2864 uint8_t buf[READ_BUF_LEN];
6f97dba0
AL		 2865 int len, size;
2866
2ea5a7af 2867 if (!s->connected || s->max_size <= 0) {
cdbf6e16 2868 return TRUE;
2ea5a7af 2869 }
6f97dba0
AL		 2870 len = sizeof(buf);
2871 if (len > s->max_size)
2872 len = s->max_size;
9977c894 2873 size = tcp_chr_recv(chr, (void *)buf, len);
4bf1cb03
NC		 2874 if (size == 0 ||
2875 (size < 0 &&
2876 socket_error() != EAGAIN && socket_error() != EWOULDBLOCK)) {
6f97dba0 2877 /* connection closed */
7b0bfdf5 2878 tcp_chr_disconnect(chr);
6f97dba0
AL		 2879 } else if (size > 0) {
2880 if (s->do_telnetopt)
2881 tcp_chr_process_IAC_bytes(chr, s, buf, &size);
2882 if (size > 0)
fa5efccb 2883 qemu_chr_be_write(chr, buf, size);
6f97dba0 2884 }
2ea5a7af
AL		 2885
2886 return TRUE;
6f97dba0
AL		 2887}
2888
7b0bfdf5
NN		 2889static int tcp_chr_sync_read(CharDriverState *chr, const uint8_t *buf, int len)
2890{
2891 TCPCharDriver *s = chr->opaque;
2892 int size;
2893
2894 if (!s->connected) {
2895 return 0;
2896 }
2897
2898 size = tcp_chr_recv(chr, (void *) buf, len);
2899 if (size == 0) {
2900 /* connection closed */
2901 tcp_chr_disconnect(chr);
2902 }
2903
2904 return size;
2905}
2906
68c18d1c
BS		 2907#ifndef _WIN32
2908CharDriverState *qemu_chr_open_eventfd(int eventfd)
2909{
e9d21c43
DM		 2910 CharDriverState *chr = qemu_chr_open_fd(eventfd, eventfd);
2911
2912 if (chr) {
2913 chr->avail_connections = 1;
2914 }
2915
2916 return chr;
6cbf4c8c 2917}
68c18d1c 2918#endif
6cbf4c8c 2919
6f97dba0
AL		 2920static void tcp_chr_connect(void *opaque)
2921{
2922 CharDriverState *chr = opaque;
2923 TCPCharDriver *s = chr->opaque;
01ca519f
CM		 2924 struct sockaddr_storage ss, ps;
2925 socklen_t ss_len = sizeof(ss), ps_len = sizeof(ps);
16cc4ffe
CM		 2926
2927 memset(&ss, 0, ss_len);
2928 if (getsockname(s->fd, (struct sockaddr *) &ss, &ss_len) != 0) {
2929 snprintf(chr->filename, CHR_MAX_FILENAME_SIZE,
2930 "Error in getsockname: %s\n", strerror(errno));
01ca519f
CM		 2931 } else if (getpeername(s->fd, (struct sockaddr *) &ps, &ps_len) != 0) {
2932 snprintf(chr->filename, CHR_MAX_FILENAME_SIZE,
2933 "Error in getpeername: %s\n", strerror(errno));
16cc4ffe 2934 } else {
01ca519f
CM		 2935 sockaddr_to_str(chr->filename, CHR_MAX_FILENAME_SIZE,
2936 &ss, ss_len, &ps, ps_len,
16cc4ffe
CM		 2937 s->is_listen, s->is_telnet);
2938 }
6f97dba0
AL		 2939
2940 s->connected = 1;
2ea5a7af 2941 if (s->chan) {
7ba9addc
AS		 2942 chr->fd_in_tag = io_add_watch_poll(s->chan, tcp_chr_read_poll,
2943 tcp_chr_read, chr);
bbdd2ad0 2944 }
fee204fd 2945 qemu_chr_be_generic_open(chr);
6f97dba0
AL		 2946}
2947
ac1b84dd
GH		 2948static void tcp_chr_update_read_handler(CharDriverState *chr)
2949{
2950 TCPCharDriver *s = chr->opaque;
2951
2952 remove_fd_in_watch(chr);
2953 if (s->chan) {
2954 chr->fd_in_tag = io_add_watch_poll(s->chan, tcp_chr_read_poll,
2955 tcp_chr_read, chr);
2956 }
2957}
2958
6f97dba0
AL		 2959#define IACSET(x,a,b,c) x[0] = a; x[1] = b; x[2] = c;
2960static void tcp_chr_telnet_init(int fd)
2961{
2962 char buf[3];
2963 /* Send the telnet negotion to put telnet in binary, no echo, single char mode */
2964 IACSET(buf, 0xff, 0xfb, 0x01); /* IAC WILL ECHO */
2965 send(fd, (char *)buf, 3, 0);
2966 IACSET(buf, 0xff, 0xfb, 0x03); /* IAC WILL Suppress go ahead */
2967 send(fd, (char *)buf, 3, 0);
2968 IACSET(buf, 0xff, 0xfb, 0x00); /* IAC WILL Binary */
2969 send(fd, (char *)buf, 3, 0);
2970 IACSET(buf, 0xff, 0xfd, 0x00); /* IAC DO Binary */
2971 send(fd, (char *)buf, 3, 0);
2972}
2973
13661089
DB		 2974static int tcp_chr_add_client(CharDriverState *chr, int fd)
2975{
2976 TCPCharDriver *s = chr->opaque;
2977 if (s->fd != -1)
2978 return -1;
2979
f9e8cacc 2980 qemu_set_nonblock(fd);
13661089
DB		 2981 if (s->do_nodelay)
2982 socket_set_nodelay(fd);
2983 s->fd = fd;
2ea5a7af 2984 s->chan = io_channel_from_socket(fd);
910b6368
PB		 2985 if (s->listen_tag) {
2986 g_source_remove(s->listen_tag);
2987 s->listen_tag = 0;
2988 }
13661089
DB		 2989 tcp_chr_connect(chr);
2990
2991 return 0;
2992}
2993
2ea5a7af 2994static gboolean tcp_chr_accept(GIOChannel *channel, GIOCondition cond, void *opaque)
6f97dba0
AL		 2995{
2996 CharDriverState *chr = opaque;
2997 TCPCharDriver *s = chr->opaque;
2998 struct sockaddr_in saddr;
2999#ifndef _WIN32
3000 struct sockaddr_un uaddr;
3001#endif
3002 struct sockaddr *addr;
3003 socklen_t len;
3004 int fd;
3005
3006 for(;;) {
3007#ifndef _WIN32
3008 if (s->is_unix) {
3009 len = sizeof(uaddr);
3010 addr = (struct sockaddr *)&uaddr;
3011 } else
3012#endif
3013 {
3014 len = sizeof(saddr);
3015 addr = (struct sockaddr *)&saddr;
3016 }
40ff6d7e 3017 fd = qemu_accept(s->listen_fd, addr, &len);
6f97dba0 3018 if (fd < 0 && errno != EINTR) {
79f20075 3019 s->listen_tag = 0;
2ea5a7af 3020 return FALSE;
6f97dba0
AL		 3021 } else if (fd >= 0) {
3022 if (s->do_telnetopt)
3023 tcp_chr_telnet_init(fd);
3024 break;
3025 }
3026 }
13661089
DB		 3027 if (tcp_chr_add_client(chr, fd) < 0)
3028 close(fd);
2ea5a7af
AL		 3029
3030 return TRUE;
6f97dba0
AL		 3031}
3032
3033static void tcp_chr_close(CharDriverState *chr)
3034{
3035 TCPCharDriver *s = chr->opaque;
c76bf6bb 3036 int i;
cfb429cb 3037
5dd1f02b
CM		 3038 if (s->reconnect_timer) {
3039 g_source_remove(s->reconnect_timer);
3040 s->reconnect_timer = 0;
3041 }
cfb429cb 3042 qapi_free_SocketAddress(s->addr);
819f56b7 3043 if (s->fd >= 0) {
26da70c7 3044 remove_fd_in_watch(chr);
2ea5a7af
AL		 3045 if (s->chan) {
3046 g_io_channel_unref(s->chan);
3047 }
6f97dba0 3048 closesocket(s->fd);
819f56b7
AL		 3049 }
3050 if (s->listen_fd >= 0) {
2ea5a7af
AL		 3051 if (s->listen_tag) {
3052 g_source_remove(s->listen_tag);
910b6368 3053 s->listen_tag = 0;
2ea5a7af
AL		 3054 }
3055 if (s->listen_chan) {
3056 g_io_channel_unref(s->listen_chan);
3057 }
6f97dba0 3058 closesocket(s->listen_fd);
819f56b7 3059 }
c76bf6bb
NN		 3060 if (s->read_msgfds_num) {
3061 for (i = 0; i < s->read_msgfds_num; i++) {
3062 close(s->read_msgfds[i]);
3063 }
3064 g_free(s->read_msgfds);
3065 }
d39aac7a
NN		 3066 if (s->write_msgfds_num) {
3067 g_free(s->write_msgfds);
3068 }
7267c094 3069 g_free(s);
a425d23f 3070 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
6f97dba0
AL		 3071}
3072
16cc4ffe 3073static void qemu_chr_finish_socket_connection(CharDriverState *chr, int fd)
6f97dba0 3074{
43ded1a0 3075 TCPCharDriver *s = chr->opaque;
f6bd5d6e 3076
cfb429cb 3077 if (s->is_listen) {
f6bd5d6e 3078 s->listen_fd = fd;
2ea5a7af 3079 s->listen_chan = io_channel_from_socket(s->listen_fd);
43ded1a0
CM		 3080 s->listen_tag = g_io_add_watch(s->listen_chan, G_IO_IN,
3081 tcp_chr_accept, chr);
f6bd5d6e
GH		 3082 } else {
3083 s->connected = 1;
3084 s->fd = fd;
3085 socket_set_nodelay(fd);
2ea5a7af 3086 s->chan = io_channel_from_socket(s->fd);
f6bd5d6e
GH		 3087 tcp_chr_connect(chr);
3088 }
43ded1a0
CM		 3089}
3090
51795029 3091static void qemu_chr_socket_connected(int fd, Error *err, void *opaque)
5dd1f02b
CM		 3092{
3093 CharDriverState *chr = opaque;
5008e5b7 3094 TCPCharDriver *s = chr->opaque;
5dd1f02b
CM		 3095
3096 if (fd < 0) {
5008e5b7 3097 check_report_connect_error(chr, err);
5dd1f02b
CM		 3098 return;
3099 }
3100
5008e5b7 3101 s->connect_err_reported = false;
5dd1f02b
CM		 3102 qemu_chr_finish_socket_connection(chr, fd);
3103}
3104
cfb429cb 3105static bool qemu_chr_open_socket_fd(CharDriverState *chr, Error **errp)
43ded1a0 3106{
cfb429cb 3107 TCPCharDriver *s = chr->opaque;
43ded1a0
CM		 3108 int fd;
3109
cfb429cb
CM		 3110 if (s->is_listen) {
3111 fd = socket_listen(s->addr, errp);
5dd1f02b
CM		 3112 } else if (s->reconnect_time) {
3113 fd = socket_connect(s->addr, errp, qemu_chr_socket_connected, chr);
3114 return fd >= 0;
3115 } else {
cfb429cb 3116 fd = socket_connect(s->addr, errp, NULL, NULL);
f6bd5d6e 3117 }
43ded1a0
CM		 3118 if (fd < 0) {
3119 return false;
3120 }
3121
16cc4ffe
CM		 3122 qemu_chr_finish_socket_connection(chr, fd);
3123 return true;
f6bd5d6e
GH		 3124}
3125
51767e7c 3126/*********************************************************/
3949e594 3127/* Ring buffer chardev */
51767e7c
LL		 3128
3129typedef struct {
3130 size_t size;
3131 size_t prod;
3132 size_t cons;
3133 uint8_t *cbuf;
3949e594 3134} RingBufCharDriver;
51767e7c 3135
3949e594 3136static size_t ringbuf_count(const CharDriverState *chr)
51767e7c 3137{
3949e594 3138 const RingBufCharDriver *d = chr->opaque;
51767e7c 3139
5c230105 3140 return d->prod - d->cons;
51767e7c
LL		 3141}
3142
9005b2a7 3143/* Called with chr_write_lock held. */
3949e594 3144static int ringbuf_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
51767e7c 3145{
3949e594 3146 RingBufCharDriver *d = chr->opaque;
51767e7c
LL		 3147 int i;
3148
3149 if (!buf || (len < 0)) {
3150 return -1;
3151 }
3152
3153 for (i = 0; i < len; i++ ) {
5c230105
MA		 3154 d->cbuf[d->prod++ & (d->size - 1)] = buf[i];
3155 if (d->prod - d->cons > d->size) {
51767e7c
LL		 3156 d->cons = d->prod - d->size;
3157 }
3158 }
3159
3160 return 0;
3161}
3162
3949e594 3163static int ringbuf_chr_read(CharDriverState *chr, uint8_t *buf, int len)
51767e7c 3164{
3949e594 3165 RingBufCharDriver *d = chr->opaque;
51767e7c
LL		 3166 int i;
3167
9005b2a7 3168 qemu_mutex_lock(&chr->chr_write_lock);
5c230105
MA		 3169 for (i = 0; i < len && d->cons != d->prod; i++) {
3170 buf[i] = d->cbuf[d->cons++ & (d->size - 1)];
51767e7c 3171 }
9005b2a7 3172 qemu_mutex_unlock(&chr->chr_write_lock);
51767e7c
LL		 3173
3174 return i;
3175}
3176
3949e594 3177static void ringbuf_chr_close(struct CharDriverState *chr)
51767e7c 3178{
3949e594 3179 RingBufCharDriver *d = chr->opaque;
51767e7c
LL		 3180
3181 g_free(d->cbuf);
3182 g_free(d);
3183 chr->opaque = NULL;
3184}
3185
4f57378f
MA		 3186static CharDriverState *qemu_chr_open_ringbuf(ChardevRingbuf *opts,
3187 Error **errp)
51767e7c
LL		 3188{
3189 CharDriverState *chr;
3949e594 3190 RingBufCharDriver *d;
51767e7c 3191
db39fcf1 3192 chr = qemu_chr_alloc();
51767e7c
LL		 3193 d = g_malloc(sizeof(*d));
3194
1da48c65 3195 d->size = opts->has_size ? opts->size : 65536;
51767e7c
LL		 3196
3197 /* The size must be power of 2 */
3198 if (d->size & (d->size - 1)) {
4f57378f 3199 error_setg(errp, "size of ringbuf chardev must be power of two");
51767e7c
LL		 3200 goto fail;
3201 }
3202
3203 d->prod = 0;
3204 d->cons = 0;
3205 d->cbuf = g_malloc0(d->size);
3206
3207 chr->opaque = d;
3949e594
MA		 3208 chr->chr_write = ringbuf_chr_write;
3209 chr->chr_close = ringbuf_chr_close;
51767e7c
LL		 3210
3211 return chr;
3212
3213fail:
3214 g_free(d);
3215 g_free(chr);
3216 return NULL;
3217}
3218
8e597779 3219bool chr_is_ringbuf(const CharDriverState *chr)
1f590cf9 3220{
3949e594 3221 return chr->chr_write == ringbuf_chr_write;
1f590cf9
LL		 3222}
3223
3949e594 3224void qmp_ringbuf_write(const char *device, const char *data,
82e59a67 3225 bool has_format, enum DataFormat format,
1f590cf9
LL		 3226 Error **errp)
3227{
3228 CharDriverState *chr;
c4f331b6 3229 const uint8_t *write_data;
1f590cf9 3230 int ret;
3d1bba20 3231 gsize write_count;
1f590cf9
LL		 3232
3233 chr = qemu_chr_find(device);
3234 if (!chr) {
1a69278e 3235 error_setg(errp, "Device '%s' not found", device);
1f590cf9
LL		 3236 return;
3237 }
3238
3949e594
MA		 3239 if (!chr_is_ringbuf(chr)) {
3240 error_setg(errp,"%s is not a ringbuf device", device);
1f590cf9
LL		 3241 return;
3242 }
3243
1f590cf9
LL		 3244 if (has_format && (format == DATA_FORMAT_BASE64)) {
3245 write_data = g_base64_decode(data, &write_count);
3246 } else {
3247 write_data = (uint8_t *)data;
82e59a67 3248 write_count = strlen(data);
1f590cf9
LL		 3249 }
3250
3949e594 3251 ret = ringbuf_chr_write(chr, write_data, write_count);
1f590cf9 3252
13289fb5
MA		 3253 if (write_data != (uint8_t *)data) {
3254 g_free((void *)write_data);
3255 }
3256
1f590cf9
LL		 3257 if (ret < 0) {
3258 error_setg(errp, "Failed to write to device %s", device);
3259 return;
3260 }
3261}
3262
3949e594 3263char *qmp_ringbuf_read(const char *device, int64_t size,
3ab651fc
MA		 3264 bool has_format, enum DataFormat format,
3265 Error **errp)
49b6d722
LL		 3266{
3267 CharDriverState *chr;
c4f331b6 3268 uint8_t *read_data;
49b6d722 3269 size_t count;
3ab651fc 3270 char *data;
49b6d722
LL		 3271
3272 chr = qemu_chr_find(device);
3273 if (!chr) {
1a69278e 3274 error_setg(errp, "Device '%s' not found", device);
49b6d722
LL		 3275 return NULL;
3276 }
3277
3949e594
MA		 3278 if (!chr_is_ringbuf(chr)) {
3279 error_setg(errp,"%s is not a ringbuf device", device);
49b6d722
LL		 3280 return NULL;
3281 }
3282
3283 if (size <= 0) {
3284 error_setg(errp, "size must be greater than zero");
3285 return NULL;
3286 }
3287
3949e594 3288 count = ringbuf_count(chr);
49b6d722 3289 size = size > count ? count : size;
44f3bcd2 3290 read_data = g_malloc(size + 1);
49b6d722 3291
3949e594 3292 ringbuf_chr_read(chr, read_data, size);
49b6d722
LL		 3293
3294 if (has_format && (format == DATA_FORMAT_BASE64)) {
3ab651fc 3295 data = g_base64_encode(read_data, size);
13289fb5 3296 g_free(read_data);
49b6d722 3297 } else {
3949e594
MA		 3298 /*
3299 * FIXME should read only complete, valid UTF-8 characters up
3300 * to @size bytes. Invalid sequences should be replaced by a
3301 * suitable replacement character. Except when (and only
3302 * when) ring buffer lost characters since last read, initial
3303 * continuation characters should be dropped.
3304 */
44f3bcd2 3305 read_data[size] = 0;
3ab651fc 3306 data = (char *)read_data;
49b6d722
LL		 3307 }
3308
3ab651fc 3309 return data;
49b6d722
LL		 3310}
3311
33521634 3312QemuOpts *qemu_chr_parse_compat(const char *label, const char *filename)
191bc01b 3313{
6ea314d9 3314 char host[65], port[33], width[8], height[8];
aeb2c47a 3315 int pos;
7d31544f 3316 const char *p;
191bc01b 3317 QemuOpts *opts;
8be7e7e4 3318 Error *local_err = NULL;
191bc01b 3319
8be7e7e4 3320 opts = qemu_opts_create(qemu_find_opts("chardev"), label, 1, &local_err);
84d18f06 3321 if (local_err) {
33394884 3322 error_report_err(local_err);
191bc01b 3323 return NULL;
8be7e7e4 3324 }
191bc01b 3325
7591c5c1
GH		 3326 if (strstart(filename, "mon:", &p)) {
3327 filename = p;
f43e47db 3328 qemu_opt_set(opts, "mux", "on", &error_abort);
02c4bdf1
PB		 3329 if (strcmp(filename, "stdio") == 0) {
3330 /* Monitor is muxed to stdio: do not exit on Ctrl+C by default
3331 * but pass it to the guest. Handle this only for compat syntax,
3332 * for -chardev syntax we have special option for this.
3333 * This is what -nographic did, redirecting+muxing serial+monitor
3334 * to stdio causing Ctrl+C to be passed to guest. */
f43e47db 3335 qemu_opt_set(opts, "signal", "off", &error_abort);
02c4bdf1 3336 }
7591c5c1
GH		 3337 }
3338
f0457e8d
GH		 3339 if (strcmp(filename, "null") == 0 ||
3340 strcmp(filename, "pty") == 0 ||
3341 strcmp(filename, "msmouse") == 0 ||
dc1c21e6 3342 strcmp(filename, "braille") == 0 ||
5692399f 3343 strcmp(filename, "testdev") == 0 ||
f0457e8d 3344 strcmp(filename, "stdio") == 0) {
f43e47db 3345 qemu_opt_set(opts, "backend", filename, &error_abort);
191bc01b
GH		 3346 return opts;
3347 }
6ea314d9 3348 if (strstart(filename, "vc", &p)) {
f43e47db 3349 qemu_opt_set(opts, "backend", "vc", &error_abort);
6ea314d9 3350 if (*p == ':') {
49aa4058 3351 if (sscanf(p+1, "%7[0-9]x%7[0-9]", width, height) == 2) {
6ea314d9 3352 /* pixels */
f43e47db
MA		 3353 qemu_opt_set(opts, "width", width, &error_abort);
3354 qemu_opt_set(opts, "height", height, &error_abort);
49aa4058 3355 } else if (sscanf(p+1, "%7[0-9]Cx%7[0-9]C", width, height) == 2) {
6ea314d9 3356 /* chars */
f43e47db
MA		 3357 qemu_opt_set(opts, "cols", width, &error_abort);
3358 qemu_opt_set(opts, "rows", height, &error_abort);
6ea314d9
GH		 3359 } else {
3360 goto fail;
3361 }
3362 }
3363 return opts;
3364 }
d6c983cd 3365 if (strcmp(filename, "con:") == 0) {
f43e47db 3366 qemu_opt_set(opts, "backend", "console", &error_abort);
d6c983cd
GH		 3367 return opts;
3368 }
48b76496 3369 if (strstart(filename, "COM", NULL)) {
f43e47db
MA		 3370 qemu_opt_set(opts, "backend", "serial", &error_abort);
3371 qemu_opt_set(opts, "path", filename, &error_abort);
48b76496
GH		 3372 return opts;
3373 }
7d31544f 3374 if (strstart(filename, "file:", &p)) {
f43e47db
MA		 3375 qemu_opt_set(opts, "backend", "file", &error_abort);
3376 qemu_opt_set(opts, "path", p, &error_abort);
7d31544f
GH		 3377 return opts;
3378 }
3379 if (strstart(filename, "pipe:", &p)) {
f43e47db
MA		 3380 qemu_opt_set(opts, "backend", "pipe", &error_abort);
3381 qemu_opt_set(opts, "path", p, &error_abort);
7d31544f
GH		 3382 return opts;
3383 }
aeb2c47a
GH		 3384 if (strstart(filename, "tcp:", &p) ||
3385 strstart(filename, "telnet:", &p)) {
3386 if (sscanf(p, "%64[^:]:%32[^,]%n", host, port, &pos) < 2) {
3387 host[0] = 0;
3388 if (sscanf(p, ":%32[^,]%n", port, &pos) < 1)
3389 goto fail;
3390 }
f43e47db
MA		 3391 qemu_opt_set(opts, "backend", "socket", &error_abort);
3392 qemu_opt_set(opts, "host", host, &error_abort);
3393 qemu_opt_set(opts, "port", port, &error_abort);
aeb2c47a 3394 if (p[pos] == ',') {
dc523cd3
MA		 3395 qemu_opts_do_parse(opts, p+pos+1, NULL, &local_err);
3396 if (local_err) {
3397 error_report_err(local_err);
aeb2c47a 3398 goto fail;
dc523cd3 3399 }
aeb2c47a
GH		 3400 }
3401 if (strstart(filename, "telnet:", &p))
f43e47db 3402 qemu_opt_set(opts, "telnet", "on", &error_abort);
aeb2c47a
GH		 3403 return opts;
3404 }
7e1b35b4 3405 if (strstart(filename, "udp:", &p)) {
f43e47db 3406 qemu_opt_set(opts, "backend", "udp", &error_abort);
7e1b35b4
GH		 3407 if (sscanf(p, "%64[^:]:%32[^@,]%n", host, port, &pos) < 2) {
3408 host[0] = 0;
39324ca4 3409 if (sscanf(p, ":%32[^@,]%n", port, &pos) < 1) {
7e1b35b4
GH		 3410 goto fail;
3411 }
3412 }
f43e47db
MA		 3413 qemu_opt_set(opts, "host", host, &error_abort);
3414 qemu_opt_set(opts, "port", port, &error_abort);
7e1b35b4
GH		 3415 if (p[pos] == '@') {
3416 p += pos + 1;
3417 if (sscanf(p, "%64[^:]:%32[^,]%n", host, port, &pos) < 2) {
3418 host[0] = 0;
3419 if (sscanf(p, ":%32[^,]%n", port, &pos) < 1) {
7e1b35b4
GH		 3420 goto fail;
3421 }
3422 }
f43e47db
MA		 3423 qemu_opt_set(opts, "localaddr", host, &error_abort);
3424 qemu_opt_set(opts, "localport", port, &error_abort);
7e1b35b4
GH		 3425 }
3426 return opts;
3427 }
aeb2c47a 3428 if (strstart(filename, "unix:", &p)) {
f43e47db 3429 qemu_opt_set(opts, "backend", "socket", &error_abort);
dc523cd3
MA		 3430 qemu_opts_do_parse(opts, p, "path", &local_err);
3431 if (local_err) {
3432 error_report_err(local_err);
aeb2c47a 3433 goto fail;
dc523cd3 3434 }
aeb2c47a
GH		 3435 return opts;
3436 }
48b76496
GH		 3437 if (strstart(filename, "/dev/parport", NULL) ||
3438 strstart(filename, "/dev/ppi", NULL)) {
f43e47db
MA		 3439 qemu_opt_set(opts, "backend", "parport", &error_abort);
3440 qemu_opt_set(opts, "path", filename, &error_abort);
48b76496
GH		 3441 return opts;
3442 }
3443 if (strstart(filename, "/dev/", NULL)) {
f43e47db
MA		 3444 qemu_opt_set(opts, "backend", "tty", &error_abort);
3445 qemu_opt_set(opts, "path", filename, &error_abort);
48b76496
GH		 3446 return opts;
3447 }
191bc01b 3448
aeb2c47a 3449fail:
191bc01b
GH		 3450 qemu_opts_del(opts);
3451 return NULL;
3452}
3453
846e2e49
GH		 3454static void qemu_chr_parse_file_out(QemuOpts *opts, ChardevBackend *backend,
3455 Error **errp)
3456{
3457 const char *path = qemu_opt_get(opts, "path");
3458
3459 if (path == NULL) {
3460 error_setg(errp, "chardev: file: no filename given");
3461 return;
3462 }
3463 backend->file = g_new0(ChardevFile, 1);
3464 backend->file->out = g_strdup(path);
3465}
3466
7c358031
GH		 3467static void qemu_chr_parse_stdio(QemuOpts *opts, ChardevBackend *backend,
3468 Error **errp)
3469{
3470 backend->stdio = g_new0(ChardevStdio, 1);
3471 backend->stdio->has_signal = true;
02c4bdf1 3472 backend->stdio->signal = qemu_opt_get_bool(opts, "signal", true);
7c358031
GH		 3473}
3474
6511d396 3475#ifdef HAVE_CHARDEV_SERIAL
0f1cb51d
GH		 3476static void qemu_chr_parse_serial(QemuOpts *opts, ChardevBackend *backend,
3477 Error **errp)
3478{
3479 const char *device = qemu_opt_get(opts, "path");
3480
3481 if (device == NULL) {
3482 error_setg(errp, "chardev: serial/tty: no device path given");
3483 return;
3484 }
3485 backend->serial = g_new0(ChardevHostdev, 1);
3486 backend->serial->device = g_strdup(device);
3487}
6511d396 3488#endif
0f1cb51d 3489
38bfb1a6 3490#ifdef HAVE_CHARDEV_PARPORT
dc375097
GH		 3491static void qemu_chr_parse_parallel(QemuOpts *opts, ChardevBackend *backend,
3492 Error **errp)
3493{
3494 const char *device = qemu_opt_get(opts, "path");
3495
3496 if (device == NULL) {
3497 error_setg(errp, "chardev: parallel: no device path given");
3498 return;
3499 }
3500 backend->parallel = g_new0(ChardevHostdev, 1);
3501 backend->parallel->device = g_strdup(device);
3502}
38bfb1a6 3503#endif
dc375097 3504
548cbb36
GH		 3505static void qemu_chr_parse_pipe(QemuOpts *opts, ChardevBackend *backend,
3506 Error **errp)
3507{
3508 const char *device = qemu_opt_get(opts, "path");
3509
3510 if (device == NULL) {
3511 error_setg(errp, "chardev: pipe: no device path given");
3512 return;
3513 }
3514 backend->pipe = g_new0(ChardevHostdev, 1);
3515 backend->pipe->device = g_strdup(device);
3516}
3517
4f57378f
MA		 3518static void qemu_chr_parse_ringbuf(QemuOpts *opts, ChardevBackend *backend,
3519 Error **errp)
1da48c65
GH		 3520{
3521 int val;
3522
3a1da42e 3523 backend->ringbuf = g_new0(ChardevRingbuf, 1);
1da48c65 3524
0f953051 3525 val = qemu_opt_get_size(opts, "size", 0);
1da48c65 3526 if (val != 0) {
3a1da42e
MA		 3527 backend->ringbuf->has_size = true;
3528 backend->ringbuf->size = val;
1da48c65
GH		 3529 }
3530}
3531
bb6fb7c0
GH		 3532static void qemu_chr_parse_mux(QemuOpts *opts, ChardevBackend *backend,
3533 Error **errp)
3534{
3535 const char *chardev = qemu_opt_get(opts, "chardev");
3536
3537 if (chardev == NULL) {
3538 error_setg(errp, "chardev: mux: no chardev given");
3539 return;
3540 }
3541 backend->mux = g_new0(ChardevMux, 1);
3542 backend->mux->chardev = g_strdup(chardev);
3543}
3544
dafd325d
PM		 3545static void qemu_chr_parse_socket(QemuOpts *opts, ChardevBackend *backend,
3546 Error **errp)
3547{
3548 bool is_listen = qemu_opt_get_bool(opts, "server", false);
3549 bool is_waitconnect = is_listen && qemu_opt_get_bool(opts, "wait", true);
3550 bool is_telnet = qemu_opt_get_bool(opts, "telnet", false);
3551 bool do_nodelay = !qemu_opt_get_bool(opts, "delay", true);
5dd1f02b 3552 int64_t reconnect = qemu_opt_get_number(opts, "reconnect", 0);
dafd325d
PM		 3553 const char *path = qemu_opt_get(opts, "path");
3554 const char *host = qemu_opt_get(opts, "host");
3555 const char *port = qemu_opt_get(opts, "port");
3556 SocketAddress *addr;
3557
3558 if (!path) {
3559 if (!host) {
3560 error_setg(errp, "chardev: socket: no host given");
3561 return;
3562 }
3563 if (!port) {
3564 error_setg(errp, "chardev: socket: no port given");
3565 return;
3566 }
3567 }
3568
3569 backend->socket = g_new0(ChardevSocket, 1);
3570
3571 backend->socket->has_nodelay = true;
3572 backend->socket->nodelay = do_nodelay;
3573 backend->socket->has_server = true;
3574 backend->socket->server = is_listen;
3575 backend->socket->has_telnet = true;
3576 backend->socket->telnet = is_telnet;
3577 backend->socket->has_wait = true;
3578 backend->socket->wait = is_waitconnect;
5dd1f02b
CM		 3579 backend->socket->has_reconnect = true;
3580 backend->socket->reconnect = reconnect;
dafd325d
PM		 3581
3582 addr = g_new0(SocketAddress, 1);
3583 if (path) {
3584 addr->kind = SOCKET_ADDRESS_KIND_UNIX;
3585 addr->q_unix = g_new0(UnixSocketAddress, 1);
3586 addr->q_unix->path = g_strdup(path);
3587 } else {
3588 addr->kind = SOCKET_ADDRESS_KIND_INET;
3589 addr->inet = g_new0(InetSocketAddress, 1);
3590 addr->inet->host = g_strdup(host);
3591 addr->inet->port = g_strdup(port);
3592 addr->inet->has_to = qemu_opt_get(opts, "to");
3593 addr->inet->to = qemu_opt_get_number(opts, "to", 0);
3594 addr->inet->has_ipv4 = qemu_opt_get(opts, "ipv4");
3595 addr->inet->ipv4 = qemu_opt_get_bool(opts, "ipv4", 0);
3596 addr->inet->has_ipv6 = qemu_opt_get(opts, "ipv6");
3597 addr->inet->ipv6 = qemu_opt_get_bool(opts, "ipv6", 0);
3598 }
3599 backend->socket->addr = addr;
3600}
3601
90a14bfe
PM		 3602static void qemu_chr_parse_udp(QemuOpts *opts, ChardevBackend *backend,
3603 Error **errp)
3604{
3605 const char *host = qemu_opt_get(opts, "host");
3606 const char *port = qemu_opt_get(opts, "port");
3607 const char *localaddr = qemu_opt_get(opts, "localaddr");
3608 const char *localport = qemu_opt_get(opts, "localport");
3609 bool has_local = false;
3610 SocketAddress *addr;
3611
3612 if (host == NULL || strlen(host) == 0) {
3613 host = "localhost";
3614 }
3615 if (port == NULL || strlen(port) == 0) {
3616 error_setg(errp, "chardev: udp: remote port not specified");
3617 return;
3618 }
3619 if (localport == NULL || strlen(localport) == 0) {
3620 localport = "0";
3621 } else {
3622 has_local = true;
3623 }
3624 if (localaddr == NULL || strlen(localaddr) == 0) {
3625 localaddr = "";
3626 } else {
3627 has_local = true;
3628 }
3629
3630 backend->udp = g_new0(ChardevUdp, 1);
3631
3632 addr = g_new0(SocketAddress, 1);
3633 addr->kind = SOCKET_ADDRESS_KIND_INET;
3634 addr->inet = g_new0(InetSocketAddress, 1);
3635 addr->inet->host = g_strdup(host);
3636 addr->inet->port = g_strdup(port);
3637 addr->inet->has_ipv4 = qemu_opt_get(opts, "ipv4");
3638 addr->inet->ipv4 = qemu_opt_get_bool(opts, "ipv4", 0);
3639 addr->inet->has_ipv6 = qemu_opt_get(opts, "ipv6");
3640 addr->inet->ipv6 = qemu_opt_get_bool(opts, "ipv6", 0);
3641 backend->udp->remote = addr;
3642
3643 if (has_local) {
3644 backend->udp->has_local = true;
3645 addr = g_new0(SocketAddress, 1);
3646 addr->kind = SOCKET_ADDRESS_KIND_INET;
3647 addr->inet = g_new0(InetSocketAddress, 1);
3648 addr->inet->host = g_strdup(localaddr);
3649 addr->inet->port = g_strdup(localport);
3650 backend->udp->local = addr;
3651 }
3652}
3653
d654f34e 3654typedef struct CharDriver {
191bc01b 3655 const char *name;
99aec012 3656 ChardevBackendKind kind;
2c5f4882 3657 void (*parse)(QemuOpts *opts, ChardevBackend *backend, Error **errp);
4ca17281
PB		 3658 CharDriverState *(*create)(const char *id, ChardevBackend *backend,
3659 ChardevReturn *ret, Error **errp);
d654f34e
AL		 3660} CharDriver;
3661
3662static GSList *backends;
3663
e4d50d47 3664void register_char_driver(const char *name, ChardevBackendKind kind,
4ca17281
PB		 3665 void (*parse)(QemuOpts *opts, ChardevBackend *backend, Error **errp),
3666 CharDriverState *(*create)(const char *id, ChardevBackend *backend,
3667 ChardevReturn *ret, Error **errp))
2c5f4882
GH		 3668{
3669 CharDriver *s;
3670
3671 s = g_malloc0(sizeof(*s));
3672 s->name = g_strdup(name);
3673 s->kind = kind;
3674 s->parse = parse;
4ca17281 3675 s->create = create;
2c5f4882
GH		 3676
3677 backends = g_slist_append(backends, s);
3678}
3679
f69554b9 3680CharDriverState *qemu_chr_new_from_opts(QemuOpts *opts,
bd2d80b2
GH		 3681 void (*init)(struct CharDriverState *s),
3682 Error **errp)
191bc01b 3683{
0aff637e 3684 Error *local_err = NULL;
d654f34e 3685 CharDriver *cd;
191bc01b 3686 CharDriverState *chr;
d654f34e 3687 GSList *i;
a61ae7f8
PM		 3688 ChardevReturn *ret = NULL;
3689 ChardevBackend *backend;
3690 const char *id = qemu_opts_id(opts);
3691 char *bid = NULL;
191bc01b 3692
a61ae7f8 3693 if (id == NULL) {
312fd5f2 3694 error_setg(errp, "chardev: no id specified");
2274ae9d 3695 goto err;
191bc01b
GH		 3696 }
3697
1bbd185f 3698 if (qemu_opt_get(opts, "backend") == NULL) {
312fd5f2 3699 error_setg(errp, "chardev: \"%s\" missing backend",
bd2d80b2 3700 qemu_opts_id(opts));
2274ae9d 3701 goto err;
1bbd185f 3702 }
d654f34e
AL		 3703 for (i = backends; i; i = i->next) {
3704 cd = i->data;
3705
3706 if (strcmp(cd->name, qemu_opt_get(opts, "backend")) == 0) {
191bc01b 3707 break;
d654f34e 3708 }
191bc01b 3709 }
d654f34e 3710 if (i == NULL) {
312fd5f2 3711 error_setg(errp, "chardev: backend \"%s\" not found",
bd2d80b2 3712 qemu_opt_get(opts, "backend"));
e668287d 3713 goto err;
191bc01b
GH		 3714 }
3715
a61ae7f8 3716 backend = g_new0(ChardevBackend, 1);
edb2fb3c 3717
a61ae7f8
PM		 3718 if (qemu_opt_get_bool(opts, "mux", 0)) {
3719 bid = g_strdup_printf("%s-base", id);
3720 }
2c5f4882 3721
a61ae7f8
PM		 3722 chr = NULL;
3723 backend->kind = cd->kind;
3724 if (cd->parse) {
3725 cd->parse(opts, backend, &local_err);
3726 if (local_err) {
3727 error_propagate(errp, local_err);
2c5f4882
GH		 3728 goto qapi_out;
3729 }
2c5f4882 3730 }
a61ae7f8
PM		 3731 ret = qmp_chardev_add(bid ? bid : id, backend, errp);
3732 if (!ret) {
3733 goto qapi_out;
191bc01b
GH		 3734 }
3735
a61ae7f8
PM		 3736 if (bid) {
3737 qapi_free_ChardevBackend(backend);
3738 qapi_free_ChardevReturn(ret);
3739 backend = g_new0(ChardevBackend, 1);
3740 backend->mux = g_new0(ChardevMux, 1);
3741 backend->kind = CHARDEV_BACKEND_KIND_MUX;
3742 backend->mux->chardev = g_strdup(bid);
3743 ret = qmp_chardev_add(id, backend, errp);
3744 if (!ret) {
3745 chr = qemu_chr_find(bid);
3746 qemu_chr_delete(chr);
3747 chr = NULL;
3748 goto qapi_out;
3749 }
bd5c51ee 3750 }
7591c5c1 3751
a61ae7f8 3752 chr = qemu_chr_find(id);
2274ae9d 3753 chr->opts = opts;
a61ae7f8
PM		 3754
3755qapi_out:
3756 qapi_free_ChardevBackend(backend);
3757 qapi_free_ChardevReturn(ret);
3758 g_free(bid);
191bc01b 3759 return chr;
2274ae9d
GH		 3760
3761err:
3762 qemu_opts_del(opts);
3763 return NULL;
191bc01b
GH		 3764}
3765
27143a44 3766CharDriverState *qemu_chr_new(const char *label, const char *filename, void (*init)(struct CharDriverState *s))
6f97dba0
AL		 3767{
3768 const char *p;
3769 CharDriverState *chr;
191bc01b 3770 QemuOpts *opts;
bd2d80b2 3771 Error *err = NULL;
191bc01b 3772
c845f401
GH		 3773 if (strstart(filename, "chardev:", &p)) {
3774 return qemu_chr_find(p);
3775 }
3776
191bc01b 3777 opts = qemu_chr_parse_compat(label, filename);
7e1b35b4
GH		 3778 if (!opts)
3779 return NULL;
6f97dba0 3780
bd2d80b2 3781 chr = qemu_chr_new_from_opts(opts, init, &err);
84d18f06 3782 if (err) {
565f65d2 3783 error_report_err(err);
bd2d80b2 3784 }
7e1b35b4 3785 if (chr && qemu_opt_get_bool(opts, "mux", 0)) {
456d6069 3786 qemu_chr_fe_claim_no_fail(chr);
7e1b35b4 3787 monitor_init(chr, MONITOR_USE_READLINE);
6f97dba0
AL		 3788 }
3789 return chr;
3790}
3791
15f31519 3792void qemu_chr_fe_set_echo(struct CharDriverState *chr, bool echo)
c48855e1
PB		 3793{
3794 if (chr->chr_set_echo) {
3795 chr->chr_set_echo(chr, echo);
3796 }
3797}
3798
8e25daa8 3799void qemu_chr_fe_set_open(struct CharDriverState *chr, int fe_open)
7c32c4fe 3800{
8e25daa8 3801 if (chr->fe_open == fe_open) {
c0c4bd2c
HG		 3802 return;
3803 }
8e25daa8 3804 chr->fe_open = fe_open;
574b711a
HG		 3805 if (chr->chr_set_fe_open) {
3806 chr->chr_set_fe_open(chr, fe_open);
7c32c4fe
HG		 3807 }
3808}
3809
d61b0c9a
MAL		 3810void qemu_chr_fe_event(struct CharDriverState *chr, int event)
3811{
3812 if (chr->chr_fe_event) {
3813 chr->chr_fe_event(chr, event);
3814 }
3815}
3816
2c8a5942
KW		 3817int qemu_chr_fe_add_watch(CharDriverState *s, GIOCondition cond,
3818 GIOFunc func, void *user_data)
23673ca7
AL		 3819{
3820 GSource *src;
3821 guint tag;
3822
3823 if (s->chr_add_watch == NULL) {
3824 return -ENOSYS;
3825 }
3826
3827 src = s->chr_add_watch(s, cond);
62c339c5
PB		 3828 if (!src) {
3829 return -EINVAL;
3830 }
3831
23673ca7
AL		 3832 g_source_set_callback(src, (GSourceFunc)func, user_data, NULL);
3833 tag = g_source_attach(src, NULL);
3834 g_source_unref(src);
3835
3836 return tag;
3837}
3838
44c473de
HG		 3839int qemu_chr_fe_claim(CharDriverState *s)
3840{
3841 if (s->avail_connections < 1) {
3842 return -1;
3843 }
3844 s->avail_connections--;
3845 return 0;
3846}
3847
3848void qemu_chr_fe_claim_no_fail(CharDriverState *s)
3849{
3850 if (qemu_chr_fe_claim(s) != 0) {
3851 fprintf(stderr, "%s: error chardev \"%s\" already used\n",
3852 __func__, s->label);
3853 exit(1);
3854 }
3855}
3856
3857void qemu_chr_fe_release(CharDriverState *s)
3858{
3859 s->avail_connections++;
3860}
3861
70f24fb6 3862void qemu_chr_delete(CharDriverState *chr)
6f97dba0 3863{
72cf2d4f 3864 QTAILQ_REMOVE(&chardevs, chr, next);
2274ae9d 3865 if (chr->chr_close) {
6f97dba0 3866 chr->chr_close(chr);
2274ae9d 3867 }
7267c094
AL		 3868 g_free(chr->filename);
3869 g_free(chr->label);
4ad60880 3870 qemu_opts_del(chr->opts);
7267c094 3871 g_free(chr);
6f97dba0
AL		 3872}
3873
c5a415a0 3874ChardevInfoList *qmp_query_chardev(Error **errp)
6f97dba0 3875{
c5a415a0 3876 ChardevInfoList *chr_list = NULL;
6f97dba0
AL		 3877 CharDriverState *chr;
3878
72cf2d4f 3879 QTAILQ_FOREACH(chr, &chardevs, next) {
c5a415a0
LC		 3880 ChardevInfoList *info = g_malloc0(sizeof(*info));
3881 info->value = g_malloc0(sizeof(*info->value));
3882 info->value->label = g_strdup(chr->label);
3883 info->value->filename = g_strdup(chr->filename);
32a97ea1 3884 info->value->frontend_open = chr->fe_open;
c5a415a0
LC		 3885
3886 info->next = chr_list;
3887 chr_list = info;
6f97dba0 3888 }
588b3832 3889
c5a415a0 3890 return chr_list;
6f97dba0 3891}
c845f401 3892
77d1c3c6
MK		 3893ChardevBackendInfoList *qmp_query_chardev_backends(Error **errp)
3894{
3895 ChardevBackendInfoList *backend_list = NULL;
3896 CharDriver *c = NULL;
3897 GSList *i = NULL;
3898
3899 for (i = backends; i; i = i->next) {
3900 ChardevBackendInfoList *info = g_malloc0(sizeof(*info));
3901 c = i->data;
3902 info->value = g_malloc0(sizeof(*info->value));
3903 info->value->name = g_strdup(c->name);
3904
3905 info->next = backend_list;
3906 backend_list = info;
3907 }
3908
3909 return backend_list;
3910}
3911
c845f401
GH		 3912CharDriverState *qemu_chr_find(const char *name)
3913{
3914 CharDriverState *chr;
3915
72cf2d4f 3916 QTAILQ_FOREACH(chr, &chardevs, next) {
c845f401
GH		 3917 if (strcmp(chr->label, name) != 0)
3918 continue;
3919 return chr;
3920 }
3921 return NULL;
3922}
0beb4942
AL		 3923
3924/* Get a character (serial) device interface. */
3925CharDriverState *qemu_char_get_next_serial(void)
3926{
3927 static int next_serial;
456d6069 3928 CharDriverState *chr;
0beb4942
AL		 3929
3930 /* FIXME: This function needs to go away: use chardev properties! */
456d6069
HG		 3931
3932 while (next_serial < MAX_SERIAL_PORTS && serial_hds[next_serial]) {
3933 chr = serial_hds[next_serial++];
3934 qemu_chr_fe_claim_no_fail(chr);
3935 return chr;
3936 }
3937 return NULL;
0beb4942
AL		 3938}
3939
4d454574
PB		 3940QemuOptsList qemu_chardev_opts = {
3941 .name = "chardev",
3942 .implied_opt_name = "backend",
3943 .head = QTAILQ_HEAD_INITIALIZER(qemu_chardev_opts.head),
3944 .desc = {
3945 {
3946 .name = "backend",
3947 .type = QEMU_OPT_STRING,
3948 },{
3949 .name = "path",
3950 .type = QEMU_OPT_STRING,
3951 },{
3952 .name = "host",
3953 .type = QEMU_OPT_STRING,
3954 },{
3955 .name = "port",
3956 .type = QEMU_OPT_STRING,
3957 },{
3958 .name = "localaddr",
3959 .type = QEMU_OPT_STRING,
3960 },{
3961 .name = "localport",
3962 .type = QEMU_OPT_STRING,
3963 },{
3964 .name = "to",
3965 .type = QEMU_OPT_NUMBER,
3966 },{
3967 .name = "ipv4",
3968 .type = QEMU_OPT_BOOL,
3969 },{
3970 .name = "ipv6",
3971 .type = QEMU_OPT_BOOL,
3972 },{
3973 .name = "wait",
3974 .type = QEMU_OPT_BOOL,
3975 },{
3976 .name = "server",
3977 .type = QEMU_OPT_BOOL,
3978 },{
3979 .name = "delay",
3980 .type = QEMU_OPT_BOOL,
5dd1f02b
CM		 3981 },{
3982 .name = "reconnect",
3983 .type = QEMU_OPT_NUMBER,
4d454574
PB		 3984 },{
3985 .name = "telnet",
3986 .type = QEMU_OPT_BOOL,
3987 },{
3988 .name = "width",
3989 .type = QEMU_OPT_NUMBER,
3990 },{
3991 .name = "height",
3992 .type = QEMU_OPT_NUMBER,
3993 },{
3994 .name = "cols",
3995 .type = QEMU_OPT_NUMBER,
3996 },{
3997 .name = "rows",
3998 .type = QEMU_OPT_NUMBER,
3999 },{
4000 .name = "mux",
4001 .type = QEMU_OPT_BOOL,
4002 },{
4003 .name = "signal",
4004 .type = QEMU_OPT_BOOL,
4005 },{
4006 .name = "name",
4007 .type = QEMU_OPT_STRING,
4008 },{
4009 .name = "debug",
4010 .type = QEMU_OPT_NUMBER,
51767e7c 4011 },{
3949e594 4012 .name = "size",
de1cc36e 4013 .type = QEMU_OPT_SIZE,
bb6fb7c0
GH		 4014 },{
4015 .name = "chardev",
4016 .type = QEMU_OPT_STRING,
4d454574
PB		 4017 },
4018 { /* end of list */ }
4019 },
4020};
f1a1a356 4021
ffbdbe59
GH		 4022#ifdef _WIN32
4023
fd5b036c
PB		 4024static CharDriverState *qmp_chardev_open_file(const char *id,
4025 ChardevBackend *backend,
4026 ChardevReturn *ret,
4027 Error **errp)
ffbdbe59 4028{
fd5b036c 4029 ChardevFile *file = backend->file;
ffbdbe59
GH		 4030 HANDLE out;
4031
e859eda5 4032 if (file->has_in) {
ffbdbe59
GH		 4033 error_setg(errp, "input file not supported");
4034 return NULL;
4035 }
4036
4037 out = CreateFile(file->out, GENERIC_WRITE, FILE_SHARE_READ, NULL,
4038 OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL, NULL);
4039 if (out == INVALID_HANDLE_VALUE) {
4040 error_setg(errp, "open %s failed", file->out);
4041 return NULL;
4042 }
4043 return qemu_chr_open_win_file(out);
4044}
4045
6511d396
PB		 4046static CharDriverState *qmp_chardev_open_serial(const char *id,
4047 ChardevBackend *backend,
4048 ChardevReturn *ret,
d36b2b90 4049 Error **errp)
d59044ef 4050{
6511d396
PB		 4051 ChardevHostdev *serial = backend->serial;
4052 return qemu_chr_open_win_path(serial->device, errp);
d36b2b90
MA		 4053}
4054
ffbdbe59
GH		 4055#else /* WIN32 */
4056
4057static int qmp_chardev_open_file_source(char *src, int flags,
4058 Error **errp)
4059{
4060 int fd = -1;
4061
4062 TFR(fd = qemu_open(src, flags, 0666));
4063 if (fd == -1) {
20c39760 4064 error_setg_file_open(errp, errno, src);
ffbdbe59
GH		 4065 }
4066 return fd;
4067}
4068
fd5b036c
PB		 4069static CharDriverState *qmp_chardev_open_file(const char *id,
4070 ChardevBackend *backend,
4071 ChardevReturn *ret,
4072 Error **errp)
ffbdbe59 4073{
fd5b036c 4074 ChardevFile *file = backend->file;
5f758366 4075 int flags, in = -1, out;
ffbdbe59
GH		 4076
4077 flags = O_WRONLY | O_TRUNC | O_CREAT | O_BINARY;
4078 out = qmp_chardev_open_file_source(file->out, flags, errp);
5f758366 4079 if (out < 0) {
ffbdbe59
GH		 4080 return NULL;
4081 }
4082
e859eda5 4083 if (file->has_in) {
ffbdbe59
GH		 4084 flags = O_RDONLY;
4085 in = qmp_chardev_open_file_source(file->in, flags, errp);
5f758366 4086 if (in < 0) {
ffbdbe59
GH		 4087 qemu_close(out);
4088 return NULL;
4089 }
4090 }
4091
4092 return qemu_chr_open_fd(in, out);
4093}
4094
d809ab95 4095#ifdef HAVE_CHARDEV_SERIAL
6511d396
PB		 4096static CharDriverState *qmp_chardev_open_serial(const char *id,
4097 ChardevBackend *backend,
4098 ChardevReturn *ret,
d36b2b90 4099 Error **errp)
d59044ef 4100{
6511d396 4101 ChardevHostdev *serial = backend->serial;
d36b2b90
MA		 4102 int fd;
4103
4104 fd = qmp_chardev_open_file_source(serial->device, O_RDWR, errp);
5f758366 4105 if (fd < 0) {
d36b2b90 4106 return NULL;
39099991 4107 }
f9e8cacc 4108 qemu_set_nonblock(fd);
d36b2b90 4109 return qemu_chr_open_tty_fd(fd);
d36b2b90 4110}
6511d396 4111#endif
d36b2b90 4112
d809ab95 4113#ifdef HAVE_CHARDEV_PARPORT
38bfb1a6
PB		 4114static CharDriverState *qmp_chardev_open_parallel(const char *id,
4115 ChardevBackend *backend,
4116 ChardevReturn *ret,
d36b2b90
MA		 4117 Error **errp)
4118{
38bfb1a6 4119 ChardevHostdev *parallel = backend->parallel;
d36b2b90
MA		 4120 int fd;
4121
4122 fd = qmp_chardev_open_file_source(parallel->device, O_RDWR, errp);
5f758366 4123 if (fd < 0) {
d59044ef
GH		 4124 return NULL;
4125 }
38bfb1a6 4126 return qemu_chr_open_pp_fd(fd, errp);
d59044ef 4127}
d809ab95 4128#endif
d59044ef 4129
ffbdbe59
GH		 4130#endif /* WIN32 */
4131
5008e5b7
CM		 4132static void socket_try_connect(CharDriverState *chr)
4133{
4134 Error *err = NULL;
4135
4136 if (!qemu_chr_open_socket_fd(chr, &err)) {
4137 check_report_connect_error(chr, err);
4138 }
4139}
4140
5dd1f02b
CM		 4141static gboolean socket_reconnect_timeout(gpointer opaque)
4142{
4143 CharDriverState *chr = opaque;
4144 TCPCharDriver *s = chr->opaque;
5dd1f02b
CM		 4145
4146 s->reconnect_timer = 0;
4147
4148 if (chr->be_open) {
4149 return false;
4150 }
4151
5008e5b7 4152 socket_try_connect(chr);
5dd1f02b
CM		 4153
4154 return false;
4155}
4156
f6bd5d6e
GH		 4157static CharDriverState *qmp_chardev_open_socket(ChardevSocket *sock,
4158 Error **errp)
4159{
43ded1a0
CM		 4160 CharDriverState *chr;
4161 TCPCharDriver *s;
f6bd5d6e
GH		 4162 SocketAddress *addr = sock->addr;
4163 bool do_nodelay = sock->has_nodelay ? sock->nodelay : false;
4164 bool is_listen = sock->has_server ? sock->server : true;
4165 bool is_telnet = sock->has_telnet ? sock->telnet : false;
4166 bool is_waitconnect = sock->has_wait ? sock->wait : false;
5dd1f02b 4167 int64_t reconnect = sock->has_reconnect ? sock->reconnect : 0;
43ded1a0
CM		 4168
4169 chr = qemu_chr_alloc();
2d528d45 4170 s = g_new0(TCPCharDriver, 1);
43ded1a0
CM		 4171
4172 s->fd = -1;
4173 s->listen_fd = -1;
4174 s->is_unix = addr->kind == SOCKET_ADDRESS_KIND_UNIX;
cfb429cb
CM		 4175 s->is_listen = is_listen;
4176 s->is_telnet = is_telnet;
43ded1a0 4177 s->do_nodelay = do_nodelay;
cfb429cb 4178 qapi_copy_SocketAddress(&s->addr, sock->addr);
43ded1a0
CM		 4179
4180 chr->opaque = s;
4181 chr->chr_write = tcp_chr_write;
4182 chr->chr_sync_read = tcp_chr_sync_read;
4183 chr->chr_close = tcp_chr_close;
4184 chr->get_msgfds = tcp_get_msgfds;
4185 chr->set_msgfds = tcp_set_msgfds;
4186 chr->chr_add_client = tcp_chr_add_client;
4187 chr->chr_add_watch = tcp_chr_add_watch;
4188 chr->chr_update_read_handler = tcp_chr_update_read_handler;
4189 /* be isn't opened until we get a connection */
4190 chr->explicit_be_open = true;
4191
4192 chr->filename = g_malloc(CHR_MAX_FILENAME_SIZE);
16cc4ffe
CM		 4193 SocketAddress_to_str(chr->filename, CHR_MAX_FILENAME_SIZE, "disconnected:",
4194 addr, is_listen, is_telnet);
f6bd5d6e
GH		 4195
4196 if (is_listen) {
43ded1a0
CM		 4197 if (is_telnet) {
4198 s->do_telnetopt = 1;
4199 }
5dd1f02b
CM		 4200 } else if (reconnect > 0) {
4201 s->reconnect_time = reconnect;
f6bd5d6e 4202 }
43ded1a0 4203
5008e5b7
CM		 4204 if (s->reconnect_time) {
4205 socket_try_connect(chr);
4206 } else if (!qemu_chr_open_socket_fd(chr, errp)) {
4207 g_free(s);
4208 g_free(chr->filename);
4209 g_free(chr);
4210 return NULL;
f6bd5d6e 4211 }
43ded1a0
CM		 4212
4213 if (is_listen && is_waitconnect) {
4214 fprintf(stderr, "QEMU waiting for connection on: %s\n",
4215 chr->filename);
4216 tcp_chr_accept(s->listen_chan, G_IO_IN, chr);
4217 qemu_set_nonblock(s->listen_fd);
4218 }
4219
4220 return chr;
f6bd5d6e
GH		 4221}
4222
08d0ab3f
LL		 4223static CharDriverState *qmp_chardev_open_udp(ChardevUdp *udp,
4224 Error **errp)
3ecc059d
GH		 4225{
4226 int fd;
4227
08d0ab3f 4228 fd = socket_dgram(udp->remote, udp->local, errp);
5f758366 4229 if (fd < 0) {
3ecc059d
GH		 4230 return NULL;
4231 }
4232 return qemu_chr_open_udp_fd(fd);
4233}
4234
f1a1a356
GH		 4235ChardevReturn *qmp_chardev_add(const char *id, ChardevBackend *backend,
4236 Error **errp)
4237{
4238 ChardevReturn *ret = g_new0(ChardevReturn, 1);
edb2fb3c 4239 CharDriverState *base, *chr = NULL;
eaeba653 4240 Error *local_err = NULL;
4ca17281
PB		 4241 GSList *i;
4242 CharDriver *cd;
f1a1a356
GH		 4243
4244 chr = qemu_chr_find(id);
4245 if (chr) {
4246 error_setg(errp, "Chardev '%s' already exists", id);
4247 g_free(ret);
4248 return NULL;
4249 }
4250
4ca17281
PB		 4251 for (i = backends; i; i = i->next) {
4252 cd = i->data;
4253
4254 if (cd->kind == backend->kind && cd->create) {
4255 chr = cd->create(id, backend, ret, &local_err);
4256 if (local_err) {
4257 error_propagate(errp, local_err);
4258 goto out_error;
4259 }
4260 break;
4261 }
4262 }
4263
4264 if (chr == NULL) {
4265 switch (backend->kind) {
4266 case CHARDEV_BACKEND_KIND_FILE:
fd5b036c 4267 abort();
4ca17281 4268 break;
4ca17281 4269 case CHARDEV_BACKEND_KIND_SERIAL:
6511d396 4270 abort();
4ca17281 4271 break;
4ca17281 4272 case CHARDEV_BACKEND_KIND_PARALLEL:
38bfb1a6 4273 abort();
4ca17281 4274 break;
4ca17281 4275 case CHARDEV_BACKEND_KIND_PIPE:
20cbe7a2 4276 abort();
4ca17281
PB		 4277 break;
4278 case CHARDEV_BACKEND_KIND_SOCKET:
4279 chr = qmp_chardev_open_socket(backend->socket, &local_err);
4280 break;
4281 case CHARDEV_BACKEND_KIND_UDP:
4282 chr = qmp_chardev_open_udp(backend->udp, &local_err);
4283 break;
d809ab95 4284#ifdef HAVE_CHARDEV_PTY
4ca17281
PB		 4285 case CHARDEV_BACKEND_KIND_PTY:
4286 chr = qemu_chr_open_pty(id, ret);
4287 break;
0a1a7fab 4288#endif
4ca17281
PB		 4289 case CHARDEV_BACKEND_KIND_NULL:
4290 chr = qemu_chr_open_null();
4291 break;
4292 case CHARDEV_BACKEND_KIND_MUX:
4293 base = qemu_chr_find(backend->mux->chardev);
4294 if (base == NULL) {
4295 error_setg(&local_err, "mux: base chardev %s not found",
4296 backend->mux->chardev);
4297 break;
4298 }
4299 chr = qemu_chr_open_mux(base);
4300 break;
4301 case CHARDEV_BACKEND_KIND_MSMOUSE:
4302 chr = qemu_chr_open_msmouse();
edb2fb3c 4303 break;
2d57286d 4304#ifdef CONFIG_BRLAPI
4ca17281
PB		 4305 case CHARDEV_BACKEND_KIND_BRAILLE:
4306 chr = chr_baum_init();
4307 break;
2d57286d 4308#endif
4ca17281
PB		 4309 case CHARDEV_BACKEND_KIND_TESTDEV:
4310 chr = chr_testdev_init();
4311 break;
4312 case CHARDEV_BACKEND_KIND_STDIO:
4313 chr = qemu_chr_open_stdio(backend->stdio);
4314 break;
d9ac374f 4315#ifdef _WIN32
4ca17281
PB		 4316 case CHARDEV_BACKEND_KIND_CONSOLE:
4317 chr = qemu_chr_open_win_con();
4318 break;
cd153e2a
GH		 4319#endif
4320#ifdef CONFIG_SPICE
4ca17281
PB		 4321 case CHARDEV_BACKEND_KIND_SPICEVMC:
4322 chr = qemu_chr_open_spice_vmc(backend->spicevmc->type);
4323 break;
4324 case CHARDEV_BACKEND_KIND_SPICEPORT:
4325 chr = qemu_chr_open_spice_port(backend->spiceport->fqdn);
4326 break;
d9ac374f 4327#endif
4ca17281
PB		 4328 case CHARDEV_BACKEND_KIND_VC:
4329 chr = vc_init(backend->vc);
4330 break;
4331 case CHARDEV_BACKEND_KIND_RINGBUF:
4332 case CHARDEV_BACKEND_KIND_MEMORY:
4333 chr = qemu_chr_open_ringbuf(backend->ringbuf, &local_err);
4334 break;
4335 default:
4336 error_setg(errp, "unknown chardev backend (%d)", backend->kind);
4337 goto out_error;
4338 }
f1a1a356 4339
4ca17281
PB		 4340 /*
4341 * Character backend open hasn't been fully converted to the Error
4342 * API. Some opens fail without setting an error. Set a generic
4343 * error then.
4344 * TODO full conversion to Error API
4345 */
4346 if (chr == NULL) {
4347 if (local_err) {
4348 error_propagate(errp, local_err);
4349 } else {
4350 error_setg(errp, "Failed to create chardev");
4351 }
4352 goto out_error;
bd5c51ee 4353 }
eaeba653
PB		 4354 }
4355
4356 chr->label = g_strdup(id);
4357 chr->avail_connections =
4358 (backend->kind == CHARDEV_BACKEND_KIND_MUX) ? MAX_MUX : 1;
4359 if (!chr->filename) {
4360 chr->filename = g_strdup(ChardevBackendKind_lookup[backend->kind]);
f1a1a356 4361 }
eaeba653
PB		 4362 if (!chr->explicit_be_open) {
4363 qemu_chr_be_event(chr, CHR_EVENT_OPENED);
4364 }
4365 QTAILQ_INSERT_TAIL(&chardevs, chr, next);
4366 return ret;
4367
4368out_error:
4369 g_free(ret);
4370 return NULL;
f1a1a356
GH		 4371}
4372
4373void qmp_chardev_remove(const char *id, Error **errp)
4374{
4375 CharDriverState *chr;
4376
4377 chr = qemu_chr_find(id);
8108fd3e 4378 if (chr == NULL) {
f1a1a356
GH		 4379 error_setg(errp, "Chardev '%s' not found", id);
4380 return;
4381 }
4382 if (chr->chr_can_read || chr->chr_read ||
4383 chr->chr_event || chr->handler_opaque) {
4384 error_setg(errp, "Chardev '%s' is busy", id);
4385 return;
4386 }
4387 qemu_chr_delete(chr);
4388}
d654f34e
AL		 4389
4390static void register_types(void)
4391{
4ca17281
PB		 4392 register_char_driver("null", CHARDEV_BACKEND_KIND_NULL, NULL,
4393 NULL);
e4d50d47 4394 register_char_driver("socket", CHARDEV_BACKEND_KIND_SOCKET,
4ca17281
PB		 4395 qemu_chr_parse_socket, NULL);
4396 register_char_driver("udp", CHARDEV_BACKEND_KIND_UDP, qemu_chr_parse_udp,
4397 NULL);
e4d50d47 4398 register_char_driver("ringbuf", CHARDEV_BACKEND_KIND_RINGBUF,
4ca17281 4399 qemu_chr_parse_ringbuf, NULL);
e4d50d47 4400 register_char_driver("file", CHARDEV_BACKEND_KIND_FILE,
fd5b036c 4401 qemu_chr_parse_file_out, qmp_chardev_open_file);
e4d50d47 4402 register_char_driver("stdio", CHARDEV_BACKEND_KIND_STDIO,
4ca17281 4403 qemu_chr_parse_stdio, NULL);
6511d396 4404#if defined HAVE_CHARDEV_SERIAL
e4d50d47 4405 register_char_driver("serial", CHARDEV_BACKEND_KIND_SERIAL,
6511d396 4406 qemu_chr_parse_serial, qmp_chardev_open_serial);
e4d50d47 4407 register_char_driver("tty", CHARDEV_BACKEND_KIND_SERIAL,
6511d396
PB		 4408 qemu_chr_parse_serial, qmp_chardev_open_serial);
4409#endif
38bfb1a6 4410#ifdef HAVE_CHARDEV_PARPORT
e4d50d47 4411 register_char_driver("parallel", CHARDEV_BACKEND_KIND_PARALLEL,
38bfb1a6 4412 qemu_chr_parse_parallel, qmp_chardev_open_parallel);
e4d50d47 4413 register_char_driver("parport", CHARDEV_BACKEND_KIND_PARALLEL,
38bfb1a6
PB		 4414 qemu_chr_parse_parallel, qmp_chardev_open_parallel);
4415#endif
4ca17281
PB		 4416 register_char_driver("pty", CHARDEV_BACKEND_KIND_PTY, NULL,
4417 NULL);
4418 register_char_driver("console", CHARDEV_BACKEND_KIND_CONSOLE, NULL,
4419 NULL);
e4d50d47 4420 register_char_driver("pipe", CHARDEV_BACKEND_KIND_PIPE,
20cbe7a2 4421 qemu_chr_parse_pipe, qemu_chr_open_pipe);
4ca17281
PB		 4422 register_char_driver("mux", CHARDEV_BACKEND_KIND_MUX, qemu_chr_parse_mux,
4423 NULL);
c11ed966 4424 /* Bug-compatibility: */
e4d50d47 4425 register_char_driver("memory", CHARDEV_BACKEND_KIND_MEMORY,
4ca17281 4426 qemu_chr_parse_ringbuf, NULL);
7b7ab18d
MR		 4427 /* this must be done after machine init, since we register FEs with muxes
4428 * as part of realize functions like serial_isa_realizefn when -nographic
4429 * is specified
4430 */
4431 qemu_add_machine_init_done_notifier(&muxes_realize_notify);
d654f34e
AL		 4432}
4433
4434type_init(register_types);
QEMU mirror