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