qemu-char.c 121.3 KB
Newer Older
A
aliguori 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
/*
 * QEMU System Emulator
 *
 * Copyright (c) 2003-2008 Fabrice Bellard
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
P
Peter Maydell 已提交
24
#include "qemu/osdep.h"
A
aliguori 已提交
25
#include "qemu-common.h"
26
#include "monitor/monitor.h"
27
#include "sysemu/sysemu.h"
28
#include "qemu/error-report.h"
29
#include "qemu/timer.h"
30
#include "sysemu/char.h"
A
aurel32 已提交
31
#include "hw/usb.h"
L
Luiz Capitulino 已提交
32
#include "qmp-commands.h"
33 34 35
#include "qapi/qmp-input-visitor.h"
#include "qapi/qmp-output-visitor.h"
#include "qapi-visit.h"
36
#include "qemu/base64.h"
37 38
#include "io/channel-socket.h"
#include "io/channel-file.h"
39
#include "io/channel-tls.h"
A
aliguori 已提交
40 41 42 43 44 45 46 47 48

#include <zlib.h>

#ifndef _WIN32
#include <sys/times.h>
#include <sys/wait.h>
#include <termios.h>
#include <sys/mman.h>
#include <sys/ioctl.h>
B
blueswir1 已提交
49
#include <sys/resource.h>
A
aliguori 已提交
50 51
#include <sys/socket.h>
#include <netinet/in.h>
B
blueswir1 已提交
52 53
#include <net/if.h>
#include <arpa/inet.h>
A
aliguori 已提交
54 55
#include <netdb.h>
#include <sys/select.h>
J
Juan Quintela 已提交
56
#ifdef CONFIG_BSD
57 58 59
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
#include <dev/ppbus/ppi.h>
#include <dev/ppbus/ppbconf.h>
60 61 62
#elif defined(__DragonFly__)
#include <dev/misc/ppi/ppi.h>
#include <bus/ppbus/ppbconf.h>
A
aliguori 已提交
63
#endif
64
#else
A
aliguori 已提交
65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82
#ifdef __linux__
#include <linux/ppdev.h>
#include <linux/parport.h>
#endif
#ifdef __sun__
#include <sys/ethernet.h>
#include <sys/sockio.h>
#include <netinet/arp.h>
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <netinet/ip.h>
#include <netinet/ip_icmp.h> // must come after ip.h
#include <netinet/udp.h>
#include <netinet/tcp.h>
#endif
#endif
#endif

83
#include "qemu/sockets.h"
A
Alon Levy 已提交
84
#include "ui/qemu-spice.h"
A
aliguori 已提交
85

86
#define READ_BUF_LEN 4096
87
#define READ_RETRIES 10
M
Michael S. Tsirkin 已提交
88
#define TCP_MAX_FDS 16
89

90 91 92
/***********************************************************/
/* Socket address helpers */

93 94
static char *SocketAddress_to_str(const char *prefix, SocketAddress *addr,
                                  bool is_listen, bool is_telnet)
95
{
96
    switch (addr->type) {
97
    case SOCKET_ADDRESS_KIND_INET:
98 99 100
        return g_strdup_printf("%s%s:%s:%s%s", prefix,
                               is_telnet ? "telnet" : "tcp", addr->u.inet->host,
                               addr->u.inet->port, is_listen ? ",server" : "");
101 102
        break;
    case SOCKET_ADDRESS_KIND_UNIX:
103 104 105
        return g_strdup_printf("%sunix:%s%s", prefix,
                               addr->u.q_unix->path,
                               is_listen ? ",server" : "");
106 107
        break;
    case SOCKET_ADDRESS_KIND_FD:
108 109
        return g_strdup_printf("%sfd:%s%s", prefix, addr->u.fd->str,
                               is_listen ? ",server" : "");
110 111 112 113 114 115
        break;
    default:
        abort();
    }
}

116 117 118
static char *sockaddr_to_str(struct sockaddr_storage *ss, socklen_t ss_len,
                             struct sockaddr_storage *ps, socklen_t ps_len,
                             bool is_listen, bool is_telnet)
119
{
120 121
    char shost[NI_MAXHOST], sserv[NI_MAXSERV];
    char phost[NI_MAXHOST], pserv[NI_MAXSERV];
122 123 124 125 126
    const char *left = "", *right = "";

    switch (ss->ss_family) {
#ifndef _WIN32
    case AF_UNIX:
127 128 129
        return g_strdup_printf("unix:%s%s",
                               ((struct sockaddr_un *)(ss))->sun_path,
                               is_listen ? ",server" : "");
130 131 132 133 134 135
#endif
    case AF_INET6:
        left  = "[";
        right = "]";
        /* fall through */
    case AF_INET:
136 137 138 139
        getnameinfo((struct sockaddr *) ss, ss_len, shost, sizeof(shost),
                    sserv, sizeof(sserv), NI_NUMERICHOST | NI_NUMERICSERV);
        getnameinfo((struct sockaddr *) ps, ps_len, phost, sizeof(phost),
                    pserv, sizeof(pserv), NI_NUMERICHOST | NI_NUMERICSERV);
140 141 142 143 144
        return g_strdup_printf("%s:%s%s%s:%s%s <-> %s%s%s:%s",
                               is_telnet ? "telnet" : "tcp",
                               left, shost, right, sserv,
                               is_listen ? ",server" : "",
                               left, phost, right, pserv);
145 146

    default:
147
        return g_strdup_printf("unknown");
148 149 150
    }
}

A
aliguori 已提交
151 152 153
/***********************************************************/
/* character device */

B
Blue Swirl 已提交
154 155
static QTAILQ_HEAD(CharDriverStateHead, CharDriverState) chardevs =
    QTAILQ_HEAD_INITIALIZER(chardevs);
A
aliguori 已提交
156

157 158 159
static void qemu_chr_free_common(CharDriverState *chr);

CharDriverState *qemu_chr_alloc(ChardevCommon *backend, Error **errp)
160 161
{
    CharDriverState *chr = g_malloc0(sizeof(CharDriverState));
162
    qemu_mutex_init(&chr->chr_write_lock);
163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183

    if (backend->has_logfile) {
        int flags = O_WRONLY | O_CREAT;
        if (backend->has_logappend &&
            backend->logappend) {
            flags |= O_APPEND;
        } else {
            flags |= O_TRUNC;
        }
        chr->logfd = qemu_open(backend->logfile, flags, 0666);
        if (chr->logfd < 0) {
            error_setg_errno(errp, errno,
                             "Unable to open logfile %s",
                             backend->logfile);
            g_free(chr);
            return NULL;
        }
    } else {
        chr->logfd = -1;
    }

184 185 186
    return chr;
}

187
void qemu_chr_be_event(CharDriverState *s, int event)
A
aliguori 已提交
188
{
189 190 191
    /* Keep track if the char device is open */
    switch (event) {
        case CHR_EVENT_OPENED:
192
            s->be_open = 1;
193 194
            break;
        case CHR_EVENT_CLOSED:
195
            s->be_open = 0;
196 197 198
            break;
    }

A
aliguori 已提交
199 200 201 202 203
    if (!s->chr_event)
        return;
    s->chr_event(s->handler_opaque, event);
}

204
void qemu_chr_be_generic_open(CharDriverState *s)
A
aliguori 已提交
205
{
206
    qemu_chr_be_event(s, CHR_EVENT_OPENED);
A
aliguori 已提交
207 208
}

209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236

/* Not reporting errors from writing to logfile, as logs are
 * defined to be "best effort" only */
static void qemu_chr_fe_write_log(CharDriverState *s,
                                  const uint8_t *buf, size_t len)
{
    size_t done = 0;
    ssize_t ret;

    if (s->logfd < 0) {
        return;
    }

    while (done < len) {
        do {
            ret = write(s->logfd, buf + done, len - done);
            if (ret == -1 && errno == EAGAIN) {
                g_usleep(100);
            }
        } while (ret == -1 && errno == EAGAIN);

        if (ret <= 0) {
            return;
        }
        done += ret;
    }
}

237
int qemu_chr_fe_write(CharDriverState *s, const uint8_t *buf, int len)
A
aliguori 已提交
238
{
239 240 241 242
    int ret;

    qemu_mutex_lock(&s->chr_write_lock);
    ret = s->chr_write(s, buf, len);
243 244 245 246 247

    if (ret > 0) {
        qemu_chr_fe_write_log(s, buf, ret);
    }

248 249
    qemu_mutex_unlock(&s->chr_write_lock);
    return ret;
A
aliguori 已提交
250 251
}

252 253 254
int qemu_chr_fe_write_all(CharDriverState *s, const uint8_t *buf, int len)
{
    int offset = 0;
255
    int res = 0;
256

257
    qemu_mutex_lock(&s->chr_write_lock);
258 259 260 261 262 263 264 265
    while (offset < len) {
        do {
            res = s->chr_write(s, buf + offset, len - offset);
            if (res == -1 && errno == EAGAIN) {
                g_usleep(100);
            }
        } while (res == -1 && errno == EAGAIN);

266
        if (res <= 0) {
267 268 269 270 271
            break;
        }

        offset += res;
    }
272 273 274 275
    if (offset > 0) {
        qemu_chr_fe_write_log(s, buf, offset);
    }

276
    qemu_mutex_unlock(&s->chr_write_lock);
277

278 279 280
    if (res < 0) {
        return res;
    }
281 282 283
    return offset;
}

284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318
int qemu_chr_fe_read_all(CharDriverState *s, uint8_t *buf, int len)
{
    int offset = 0, counter = 10;
    int res;

    if (!s->chr_sync_read) {
        return 0;
    }

    while (offset < len) {
        do {
            res = s->chr_sync_read(s, buf + offset, len - offset);
            if (res == -1 && errno == EAGAIN) {
                g_usleep(100);
            }
        } while (res == -1 && errno == EAGAIN);

        if (res == 0) {
            break;
        }

        if (res < 0) {
            return res;
        }

        offset += res;

        if (!counter--) {
            break;
        }
    }

    return offset;
}

319
int qemu_chr_fe_ioctl(CharDriverState *s, int cmd, void *arg)
A
aliguori 已提交
320 321 322 323 324 325
{
    if (!s->chr_ioctl)
        return -ENOTSUP;
    return s->chr_ioctl(s, cmd, arg);
}

326
int qemu_chr_be_can_write(CharDriverState *s)
A
aliguori 已提交
327 328 329 330 331 332
{
    if (!s->chr_can_read)
        return 0;
    return s->chr_can_read(s->handler_opaque);
}

333
void qemu_chr_be_write(CharDriverState *s, uint8_t *buf, int len)
A
aliguori 已提交
334
{
335 336 337
    if (s->chr_read) {
        s->chr_read(s->handler_opaque, buf, len);
    }
A
aliguori 已提交
338 339
}

340
int qemu_chr_fe_get_msgfd(CharDriverState *s)
341
{
342
    int fd;
343
    return (qemu_chr_fe_get_msgfds(s, &fd, 1) == 1) ? fd : -1;
344 345 346 347 348
}

int qemu_chr_fe_get_msgfds(CharDriverState *s, int *fds, int len)
{
    return s->get_msgfds ? s->get_msgfds(s, fds, len) : -1;
349 350
}

351 352 353 354 355
int qemu_chr_fe_set_msgfds(CharDriverState *s, int *fds, int num)
{
    return s->set_msgfds ? s->set_msgfds(s, fds, num) : -1;
}

356 357 358 359 360
int qemu_chr_add_client(CharDriverState *s, int fd)
{
    return s->chr_add_client ? s->chr_add_client(s, fd) : -1;
}

A
aliguori 已提交
361 362 363 364
void qemu_chr_accept_input(CharDriverState *s)
{
    if (s->chr_accept_input)
        s->chr_accept_input(s);
365
    qemu_notify_event();
A
aliguori 已提交
366 367
}

368
void qemu_chr_fe_printf(CharDriverState *s, const char *fmt, ...)
A
aliguori 已提交
369
{
370
    char buf[READ_BUF_LEN];
A
aliguori 已提交
371 372 373
    va_list ap;
    va_start(ap, fmt);
    vsnprintf(buf, sizeof(buf), fmt, ap);
374
    qemu_chr_fe_write(s, (uint8_t *)buf, strlen(buf));
A
aliguori 已提交
375 376 377
    va_end(ap);
}

378 379
static void remove_fd_in_watch(CharDriverState *chr);

A
aliguori 已提交
380
void qemu_chr_add_handlers(CharDriverState *s,
381
                           IOCanReadHandler *fd_can_read,
A
aliguori 已提交
382 383 384 385
                           IOReadHandler *fd_read,
                           IOEventHandler *fd_event,
                           void *opaque)
{
386 387
    int fe_open;

388
    if (!opaque && !fd_can_read && !fd_read && !fd_event) {
389
        fe_open = 0;
390
        remove_fd_in_watch(s);
391 392
    } else {
        fe_open = 1;
393
    }
A
aliguori 已提交
394 395 396 397
    s->chr_can_read = fd_can_read;
    s->chr_read = fd_read;
    s->chr_event = fd_event;
    s->handler_opaque = opaque;
398
    if (fe_open && s->chr_update_read_handler)
A
aliguori 已提交
399
        s->chr_update_read_handler(s);
400

401
    if (!s->explicit_fe_open) {
402
        qemu_chr_fe_set_open(s, fe_open);
403 404
    }

405 406
    /* We're connecting to an already opened device, so let's make sure we
       also get the open event */
407
    if (fe_open && s->be_open) {
408
        qemu_chr_be_generic_open(s);
409
    }
A
aliguori 已提交
410 411 412 413 414 415 416
}

static int null_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
{
    return len;
}

417 418 419 420
static CharDriverState *qemu_chr_open_null(const char *id,
                                           ChardevBackend *backend,
                                           ChardevReturn *ret,
                                           Error **errp)
A
aliguori 已提交
421 422
{
    CharDriverState *chr;
423
    ChardevCommon *common = qapi_ChardevDummy_base(backend->u.null);
A
aliguori 已提交
424

425 426 427 428
    chr = qemu_chr_alloc(common, errp);
    if (!chr) {
        return NULL;
    }
A
aliguori 已提交
429
    chr->chr_write = null_chr_write;
430
    chr->explicit_be_open = true;
431
    return chr;
A
aliguori 已提交
432 433 434 435 436 437 438
}

/* MUX driver for serial I/O splitting */
#define MAX_MUX 4
#define MUX_BUFFER_SIZE 32	/* Must be a power of 2.  */
#define MUX_BUFFER_MASK (MUX_BUFFER_SIZE - 1)
typedef struct {
439
    IOCanReadHandler *chr_can_read[MAX_MUX];
A
aliguori 已提交
440 441 442 443
    IOReadHandler *chr_read[MAX_MUX];
    IOEventHandler *chr_event[MAX_MUX];
    void *ext_opaque[MAX_MUX];
    CharDriverState *drv;
444
    int focus;
A
aliguori 已提交
445 446 447
    int mux_cnt;
    int term_got_escape;
    int max_size;
448 449 450 451 452 453
    /* Intermediate input buffer allows to catch escape sequences even if the
       currently active device is not accepting any input - but only until it
       is full as well. */
    unsigned char buffer[MAX_MUX][MUX_BUFFER_SIZE];
    int prod[MAX_MUX];
    int cons[MAX_MUX];
J
Jan Kiszka 已提交
454
    int timestamps;
455 456

    /* Protected by the CharDriverState chr_write_lock.  */
J
Jan Kiszka 已提交
457
    int linestart;
J
Jan Kiszka 已提交
458
    int64_t timestamps_start;
A
aliguori 已提交
459 460 461
} MuxDriver;


462
/* Called with chr_write_lock held.  */
A
aliguori 已提交
463 464 465 466
static int mux_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
{
    MuxDriver *d = chr->opaque;
    int ret;
J
Jan Kiszka 已提交
467
    if (!d->timestamps) {
468
        ret = qemu_chr_fe_write(d->drv, buf, len);
A
aliguori 已提交
469 470 471 472
    } else {
        int i;

        ret = 0;
J
Jan Kiszka 已提交
473 474
        for (i = 0; i < len; i++) {
            if (d->linestart) {
A
aliguori 已提交
475 476 477 478
                char buf1[64];
                int64_t ti;
                int secs;

479
                ti = qemu_clock_get_ms(QEMU_CLOCK_REALTIME);
J
Jan Kiszka 已提交
480 481 482
                if (d->timestamps_start == -1)
                    d->timestamps_start = ti;
                ti -= d->timestamps_start;
483
                secs = ti / 1000;
A
aliguori 已提交
484 485 486 487 488
                snprintf(buf1, sizeof(buf1),
                         "[%02d:%02d:%02d.%03d] ",
                         secs / 3600,
                         (secs / 60) % 60,
                         secs % 60,
489
                         (int)(ti % 1000));
490
                qemu_chr_fe_write(d->drv, (uint8_t *)buf1, strlen(buf1));
J
Jan Kiszka 已提交
491 492
                d->linestart = 0;
            }
493
            ret += qemu_chr_fe_write(d->drv, buf+i, 1);
J
Jan Kiszka 已提交
494 495
            if (buf[i] == '\n') {
                d->linestart = 1;
A
aliguori 已提交
496 497 498 499 500 501 502 503 504 505
            }
        }
    }
    return ret;
}

static const char * const mux_help[] = {
    "% h    print this help\n\r",
    "% x    exit emulator\n\r",
    "% s    save disk data back to file (if -snapshot)\n\r",
G
Gonglei 已提交
506
    "% t    toggle console timestamps\n\r",
A
aliguori 已提交
507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527
    "% b    send break (magic sysrq)\n\r",
    "% c    switch between console and monitor\n\r",
    "% %  sends %\n\r",
    NULL
};

int term_escape_char = 0x01; /* ctrl-a is used for escape */
static void mux_print_help(CharDriverState *chr)
{
    int i, j;
    char ebuf[15] = "Escape-Char";
    char cbuf[50] = "\n\r";

    if (term_escape_char > 0 && term_escape_char < 26) {
        snprintf(cbuf, sizeof(cbuf), "\n\r");
        snprintf(ebuf, sizeof(ebuf), "C-%c", term_escape_char - 1 + 'a');
    } else {
        snprintf(cbuf, sizeof(cbuf),
                 "\n\rEscape-Char set to Ascii: 0x%02x\n\r\n\r",
                 term_escape_char);
    }
528
    qemu_chr_fe_write(chr, (uint8_t *)cbuf, strlen(cbuf));
A
aliguori 已提交
529 530 531
    for (i = 0; mux_help[i] != NULL; i++) {
        for (j=0; mux_help[i][j] != '\0'; j++) {
            if (mux_help[i][j] == '%')
532
                qemu_chr_fe_write(chr, (uint8_t *)ebuf, strlen(ebuf));
A
aliguori 已提交
533
            else
534
                qemu_chr_fe_write(chr, (uint8_t *)&mux_help[i][j], 1);
A
aliguori 已提交
535 536 537 538
        }
    }
}

539 540 541 542 543 544
static void mux_chr_send_event(MuxDriver *d, int mux_nr, int event)
{
    if (d->chr_event[mux_nr])
        d->chr_event[mux_nr](d->ext_opaque[mux_nr], event);
}

A
aliguori 已提交
545 546 547 548 549 550 551 552 553 554 555 556 557 558
static int mux_proc_byte(CharDriverState *chr, MuxDriver *d, int ch)
{
    if (d->term_got_escape) {
        d->term_got_escape = 0;
        if (ch == term_escape_char)
            goto send_char;
        switch(ch) {
        case '?':
        case 'h':
            mux_print_help(chr);
            break;
        case 'x':
            {
                 const char *term =  "QEMU: Terminated\n\r";
559
                 qemu_chr_fe_write(chr, (uint8_t *)term, strlen(term));
A
aliguori 已提交
560 561 562 563
                 exit(0);
                 break;
            }
        case 's':
564
            bdrv_commit_all();
A
aliguori 已提交
565 566
            break;
        case 'b':
567
            qemu_chr_be_event(chr, CHR_EVENT_BREAK);
A
aliguori 已提交
568 569 570
            break;
        case 'c':
            /* Switch to the next registered device */
571 572 573 574 575
            mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_OUT);
            d->focus++;
            if (d->focus >= d->mux_cnt)
                d->focus = 0;
            mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_IN);
A
aliguori 已提交
576
            break;
J
Jan Kiszka 已提交
577 578 579
        case 't':
            d->timestamps = !d->timestamps;
            d->timestamps_start = -1;
J
Jan Kiszka 已提交
580
            d->linestart = 0;
J
Jan Kiszka 已提交
581
            break;
A
aliguori 已提交
582 583 584 585 586 587 588 589 590 591 592 593 594
        }
    } else if (ch == term_escape_char) {
        d->term_got_escape = 1;
    } else {
    send_char:
        return 1;
    }
    return 0;
}

static void mux_chr_accept_input(CharDriverState *chr)
{
    MuxDriver *d = chr->opaque;
595
    int m = d->focus;
A
aliguori 已提交
596

597
    while (d->prod[m] != d->cons[m] &&
A
aliguori 已提交
598 599 600
           d->chr_can_read[m] &&
           d->chr_can_read[m](d->ext_opaque[m])) {
        d->chr_read[m](d->ext_opaque[m],
601
                       &d->buffer[m][d->cons[m]++ & MUX_BUFFER_MASK], 1);
A
aliguori 已提交
602 603 604 605 606 607 608
    }
}

static int mux_chr_can_read(void *opaque)
{
    CharDriverState *chr = opaque;
    MuxDriver *d = chr->opaque;
609
    int m = d->focus;
A
aliguori 已提交
610

611
    if ((d->prod[m] - d->cons[m]) < MUX_BUFFER_SIZE)
A
aliguori 已提交
612
        return 1;
613 614
    if (d->chr_can_read[m])
        return d->chr_can_read[m](d->ext_opaque[m]);
A
aliguori 已提交
615 616 617 618 619 620 621
    return 0;
}

static void mux_chr_read(void *opaque, const uint8_t *buf, int size)
{
    CharDriverState *chr = opaque;
    MuxDriver *d = chr->opaque;
622
    int m = d->focus;
A
aliguori 已提交
623 624 625 626 627 628
    int i;

    mux_chr_accept_input (opaque);

    for(i = 0; i < size; i++)
        if (mux_proc_byte(chr, d, buf[i])) {
629
            if (d->prod[m] == d->cons[m] &&
A
aliguori 已提交
630 631 632 633
                d->chr_can_read[m] &&
                d->chr_can_read[m](d->ext_opaque[m]))
                d->chr_read[m](d->ext_opaque[m], &buf[i], 1);
            else
634
                d->buffer[m][d->prod[m]++ & MUX_BUFFER_MASK] = buf[i];
A
aliguori 已提交
635 636 637 638 639 640 641 642 643 644 645
        }
}

static void mux_chr_event(void *opaque, int event)
{
    CharDriverState *chr = opaque;
    MuxDriver *d = chr->opaque;
    int i;

    /* Send the event to all registered listeners */
    for (i = 0; i < d->mux_cnt; i++)
646
        mux_chr_send_event(d, i, event);
A
aliguori 已提交
647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665
}

static void mux_chr_update_read_handler(CharDriverState *chr)
{
    MuxDriver *d = chr->opaque;

    if (d->mux_cnt >= MAX_MUX) {
        fprintf(stderr, "Cannot add I/O handlers, MUX array is full\n");
        return;
    }
    d->ext_opaque[d->mux_cnt] = chr->handler_opaque;
    d->chr_can_read[d->mux_cnt] = chr->chr_can_read;
    d->chr_read[d->mux_cnt] = chr->chr_read;
    d->chr_event[d->mux_cnt] = chr->chr_event;
    /* Fix up the real driver with mux routines */
    if (d->mux_cnt == 0) {
        qemu_chr_add_handlers(d->drv, mux_chr_can_read, mux_chr_read,
                              mux_chr_event, chr);
    }
666 667
    if (d->focus != -1) {
        mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_OUT);
G
Gerd Hoffmann 已提交
668
    }
669
    d->focus = d->mux_cnt;
A
aliguori 已提交
670
    d->mux_cnt++;
671
    mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_IN);
A
aliguori 已提交
672 673
}

674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713
static bool muxes_realized;

/**
 * Called after processing of default and command-line-specified
 * chardevs to deliver CHR_EVENT_OPENED events to any FEs attached
 * to a mux chardev. This is done here to ensure that
 * output/prompts/banners are only displayed for the FE that has
 * focus when initial command-line processing/machine init is
 * completed.
 *
 * After this point, any new FE attached to any new or existing
 * mux will receive CHR_EVENT_OPENED notifications for the BE
 * immediately.
 */
static void muxes_realize_done(Notifier *notifier, void *unused)
{
    CharDriverState *chr;

    QTAILQ_FOREACH(chr, &chardevs, next) {
        if (chr->is_mux) {
            MuxDriver *d = chr->opaque;
            int i;

            /* send OPENED to all already-attached FEs */
            for (i = 0; i < d->mux_cnt; i++) {
                mux_chr_send_event(d, i, CHR_EVENT_OPENED);
            }
            /* mark mux as OPENED so any new FEs will immediately receive
             * OPENED event
             */
            qemu_chr_be_generic_open(chr);
        }
    }
    muxes_realized = true;
}

static Notifier muxes_realize_notify = {
    .notify = muxes_realize_done,
};

714 715 716 717 718 719
static GSource *mux_chr_add_watch(CharDriverState *s, GIOCondition cond)
{
    MuxDriver *d = s->opaque;
    return d->drv->chr_add_watch(d->drv, cond);
}

720 721 722
static CharDriverState *qemu_chr_open_mux(const char *id,
                                          ChardevBackend *backend,
                                          ChardevReturn *ret, Error **errp)
A
aliguori 已提交
723
{
724
    ChardevMux *mux = backend->u.mux;
725
    CharDriverState *chr, *drv;
A
aliguori 已提交
726
    MuxDriver *d;
727
    ChardevCommon *common = qapi_ChardevMux_base(backend->u.mux);
A
aliguori 已提交
728

729 730 731 732 733 734
    drv = qemu_chr_find(mux->chardev);
    if (drv == NULL) {
        error_setg(errp, "mux: base chardev %s not found", mux->chardev);
        return NULL;
    }

735 736 737 738
    chr = qemu_chr_alloc(common, errp);
    if (!chr) {
        return NULL;
    }
739
    d = g_new0(MuxDriver, 1);
A
aliguori 已提交
740 741 742

    chr->opaque = d;
    d->drv = drv;
743
    d->focus = -1;
A
aliguori 已提交
744 745 746
    chr->chr_write = mux_chr_write;
    chr->chr_update_read_handler = mux_chr_update_read_handler;
    chr->chr_accept_input = mux_chr_accept_input;
747
    /* Frontend guest-open / -close notification is not support with muxes */
748
    chr->chr_set_fe_open = NULL;
749 750 751
    if (drv->chr_add_watch) {
        chr->chr_add_watch = mux_chr_add_watch;
    }
752 753 754 755 756
    /* only default to opened state if we've realized the initial
     * set of muxes
     */
    chr->explicit_be_open = muxes_realized ? 0 : 1;
    chr->is_mux = 1;
757

A
aliguori 已提交
758 759 760 761
    return chr;
}


A
Anthony Liguori 已提交
762 763
typedef struct IOWatchPoll
{
764 765
    GSource parent;

766
    QIOChannel *ioc;
A
Anthony Liguori 已提交
767 768 769
    GSource *src;

    IOCanReadHandler *fd_can_read;
770
    GSourceFunc fd_read;
A
Anthony Liguori 已提交
771 772 773 774 775
    void *opaque;
} IOWatchPoll;

static IOWatchPoll *io_watch_poll_from_source(GSource *source)
{
776
    return container_of(source, IOWatchPoll, parent);
A
Anthony Liguori 已提交
777 778 779 780 781
}

static gboolean io_watch_poll_prepare(GSource *source, gint *timeout_)
{
    IOWatchPoll *iwp = io_watch_poll_from_source(source);
782
    bool now_active = iwp->fd_can_read(iwp->opaque) > 0;
783
    bool was_active = iwp->src != NULL;
784
    if (was_active == now_active) {
A
Anthony Liguori 已提交
785 786 787
        return FALSE;
    }

788
    if (now_active) {
789 790
        iwp->src = qio_channel_create_watch(
            iwp->ioc, G_IO_IN | G_IO_ERR | G_IO_HUP | G_IO_NVAL);
791
        g_source_set_callback(iwp->src, iwp->fd_read, iwp->opaque, NULL);
792 793
        g_source_attach(iwp->src, NULL);
    } else {
794 795 796
        g_source_destroy(iwp->src);
        g_source_unref(iwp->src);
        iwp->src = NULL;
797 798
    }
    return FALSE;
A
Anthony Liguori 已提交
799 800 801 802
}

static gboolean io_watch_poll_check(GSource *source)
{
803
    return FALSE;
A
Anthony Liguori 已提交
804 805 806 807 808
}

static gboolean io_watch_poll_dispatch(GSource *source, GSourceFunc callback,
                                       gpointer user_data)
{
809
    abort();
A
Anthony Liguori 已提交
810 811 812 813
}

static void io_watch_poll_finalize(GSource *source)
{
814 815 816 817 818 819 820 821 822 823
    /* Due to a glib bug, removing the last reference to a source
     * inside a finalize callback causes recursive locking (and a
     * deadlock).  This is not a problem inside other callbacks,
     * including dispatch callbacks, so we call io_remove_watch_poll
     * to remove this source.  At this point, iwp->src must
     * be NULL, or we would leak it.
     *
     * This would be solved much more elegantly by child sources,
     * but we support older glib versions that do not have them.
     */
A
Anthony Liguori 已提交
824
    IOWatchPoll *iwp = io_watch_poll_from_source(source);
825
    assert(iwp->src == NULL);
A
Anthony Liguori 已提交
826 827 828 829 830 831 832 833 834 835
}

static GSourceFuncs io_watch_poll_funcs = {
    .prepare = io_watch_poll_prepare,
    .check = io_watch_poll_check,
    .dispatch = io_watch_poll_dispatch,
    .finalize = io_watch_poll_finalize,
};

/* Can only be used for read */
836
static guint io_add_watch_poll(QIOChannel *ioc,
A
Anthony Liguori 已提交
837
                               IOCanReadHandler *fd_can_read,
838
                               QIOChannelFunc fd_read,
A
Anthony Liguori 已提交
839 840 841
                               gpointer user_data)
{
    IOWatchPoll *iwp;
842
    int tag;
A
Anthony Liguori 已提交
843

844
    iwp = (IOWatchPoll *) g_source_new(&io_watch_poll_funcs, sizeof(IOWatchPoll));
A
Anthony Liguori 已提交
845 846
    iwp->fd_can_read = fd_can_read;
    iwp->opaque = user_data;
847
    iwp->ioc = ioc;
848 849
    iwp->fd_read = (GSourceFunc) fd_read;
    iwp->src = NULL;
A
Anthony Liguori 已提交
850

851 852 853
    tag = g_source_attach(&iwp->parent, NULL);
    g_source_unref(&iwp->parent);
    return tag;
A
Anthony Liguori 已提交
854 855
}

856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874
static void io_remove_watch_poll(guint tag)
{
    GSource *source;
    IOWatchPoll *iwp;

    g_return_if_fail (tag > 0);

    source = g_main_context_find_source_by_id(NULL, tag);
    g_return_if_fail (source != NULL);

    iwp = io_watch_poll_from_source(source);
    if (iwp->src) {
        g_source_destroy(iwp->src);
        g_source_unref(iwp->src);
        iwp->src = NULL;
    }
    g_source_destroy(&iwp->parent);
}

875 876 877 878 879 880 881 882
static void remove_fd_in_watch(CharDriverState *chr)
{
    if (chr->fd_in_tag) {
        io_remove_watch_poll(chr->fd_in_tag);
        chr->fd_in_tag = 0;
    }
}

A
Anthony Liguori 已提交
883

884 885 886
static int io_channel_send_full(QIOChannel *ioc,
                                const void *buf, size_t len,
                                int *fds, size_t nfds)
887
{
888
    size_t offset = 0;
889

890 891 892 893 894 895 896 897 898 899 900 901 902 903 904
    while (offset < len) {
        ssize_t ret = 0;
        struct iovec iov = { .iov_base = (char *)buf + offset,
                             .iov_len = len - offset };

        ret = qio_channel_writev_full(
            ioc, &iov, 1,
            fds, nfds, NULL);
        if (ret == QIO_CHANNEL_ERR_BLOCK) {
            errno = EAGAIN;
            return -1;
        } else if (ret < 0) {
            if (offset) {
                return offset;
            }
905

906 907 908
            errno = EINVAL;
            return -1;
        }
909

910 911
        offset += ret;
    }
912

913
    return offset;
914 915
}

916

917
#ifndef _WIN32
918
static int io_channel_send(QIOChannel *ioc, const void *buf, size_t len)
A
Anthony Liguori 已提交
919
{
920
    return io_channel_send_full(ioc, buf, len, NULL, 0);
A
Anthony Liguori 已提交
921 922
}

B
Blue Swirl 已提交
923

924 925
typedef struct FDCharDriver {
    CharDriverState *chr;
926
    QIOChannel *ioc_in, *ioc_out;
A
aliguori 已提交
927 928 929
    int max_size;
} FDCharDriver;

930
/* Called with chr_write_lock held.  */
A
aliguori 已提交
931 932 933
static int fd_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
{
    FDCharDriver *s = chr->opaque;
934
    
935
    return io_channel_send(s->ioc_out, buf, len);
A
aliguori 已提交
936 937
}

938
static gboolean fd_chr_read(QIOChannel *chan, GIOCondition cond, void *opaque)
A
aliguori 已提交
939 940 941
{
    CharDriverState *chr = opaque;
    FDCharDriver *s = chr->opaque;
942
    int len;
943
    uint8_t buf[READ_BUF_LEN];
944
    ssize_t ret;
A
aliguori 已提交
945 946

    len = sizeof(buf);
947
    if (len > s->max_size) {
A
aliguori 已提交
948
        len = s->max_size;
949 950
    }
    if (len == 0) {
951
        return TRUE;
952 953
    }

954 955 956
    ret = qio_channel_read(
        chan, (gchar *)buf, len, NULL);
    if (ret == 0) {
957
        remove_fd_in_watch(chr);
958
        qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
959
        return FALSE;
A
aliguori 已提交
960
    }
961 962
    if (ret > 0) {
        qemu_chr_be_write(chr, buf, ret);
A
aliguori 已提交
963
    }
964 965 966 967 968 969 970 971 972 973 974

    return TRUE;
}

static int fd_chr_read_poll(void *opaque)
{
    CharDriverState *chr = opaque;
    FDCharDriver *s = chr->opaque;

    s->max_size = qemu_chr_be_can_write(chr);
    return s->max_size;
A
aliguori 已提交
975 976
}

A
Anthony Liguori 已提交
977 978 979
static GSource *fd_chr_add_watch(CharDriverState *chr, GIOCondition cond)
{
    FDCharDriver *s = chr->opaque;
980
    return qio_channel_create_watch(s->ioc_out, cond);
A
Anthony Liguori 已提交
981 982
}

A
aliguori 已提交
983 984 985 986
static void fd_chr_update_read_handler(CharDriverState *chr)
{
    FDCharDriver *s = chr->opaque;

987
    remove_fd_in_watch(chr);
988 989 990
    if (s->ioc_in) {
        chr->fd_in_tag = io_add_watch_poll(s->ioc_in,
                                           fd_chr_read_poll,
991
                                           fd_chr_read, chr);
A
aliguori 已提交
992 993 994 995 996 997 998
    }
}

static void fd_chr_close(struct CharDriverState *chr)
{
    FDCharDriver *s = chr->opaque;

999
    remove_fd_in_watch(chr);
1000 1001
    if (s->ioc_in) {
        object_unref(OBJECT(s->ioc_in));
1002
    }
1003 1004
    if (s->ioc_out) {
        object_unref(OBJECT(s->ioc_out));
A
aliguori 已提交
1005 1006
    }

1007
    g_free(s);
1008
    qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
A
aliguori 已提交
1009 1010 1011
}

/* open a character device to a unix fd */
1012 1013
static CharDriverState *qemu_chr_open_fd(int fd_in, int fd_out,
                                         ChardevCommon *backend, Error **errp)
A
aliguori 已提交
1014 1015 1016 1017
{
    CharDriverState *chr;
    FDCharDriver *s;

1018 1019 1020 1021
    chr = qemu_chr_alloc(backend, errp);
    if (!chr) {
        return NULL;
    }
1022
    s = g_new0(FDCharDriver, 1);
1023 1024
    s->ioc_in = QIO_CHANNEL(qio_channel_file_new_fd(fd_in));
    s->ioc_out = QIO_CHANNEL(qio_channel_file_new_fd(fd_out));
1025
    qemu_set_nonblock(fd_out);
1026
    s->chr = chr;
A
aliguori 已提交
1027
    chr->opaque = s;
A
Anthony Liguori 已提交
1028
    chr->chr_add_watch = fd_chr_add_watch;
A
aliguori 已提交
1029 1030 1031 1032 1033 1034 1035
    chr->chr_write = fd_chr_write;
    chr->chr_update_read_handler = fd_chr_update_read_handler;
    chr->chr_close = fd_chr_close;

    return chr;
}

1036 1037 1038 1039
static CharDriverState *qemu_chr_open_pipe(const char *id,
                                           ChardevBackend *backend,
                                           ChardevReturn *ret,
                                           Error **errp)
A
aliguori 已提交
1040
{
1041
    ChardevHostdev *opts = backend->u.pipe;
A
aliguori 已提交
1042
    int fd_in, fd_out;
1043 1044
    char *filename_in;
    char *filename_out;
1045
    const char *filename = opts->device;
1046
    ChardevCommon *common = qapi_ChardevHostdev_base(backend->u.pipe);
1047

1048 1049 1050

    filename_in = g_strdup_printf("%s.in", filename);
    filename_out = g_strdup_printf("%s.out", filename);
K
Kevin Wolf 已提交
1051 1052
    TFR(fd_in = qemu_open(filename_in, O_RDWR | O_BINARY));
    TFR(fd_out = qemu_open(filename_out, O_RDWR | O_BINARY));
1053 1054
    g_free(filename_in);
    g_free(filename_out);
A
aliguori 已提交
1055 1056 1057 1058 1059
    if (fd_in < 0 || fd_out < 0) {
	if (fd_in >= 0)
	    close(fd_in);
	if (fd_out >= 0)
	    close(fd_out);
1060
        TFR(fd_in = fd_out = qemu_open(filename, O_RDWR | O_BINARY));
1061
        if (fd_in < 0) {
1062
            error_setg_file_open(errp, errno, filename);
1063
            return NULL;
1064
        }
A
aliguori 已提交
1065
    }
1066
    return qemu_chr_open_fd(fd_in, fd_out, common, errp);
A
aliguori 已提交
1067 1068 1069 1070 1071
}

/* init terminal so that we can grab keys */
static struct termios oldtty;
static int old_fd0_flags;
1072
static bool stdio_in_use;
1073
static bool stdio_allow_signal;
1074 1075 1076
static bool stdio_echo_state;

static void qemu_chr_set_echo_stdio(CharDriverState *chr, bool echo);
A
aliguori 已提交
1077 1078 1079 1080 1081 1082 1083

static void term_exit(void)
{
    tcsetattr (0, TCSANOW, &oldtty);
    fcntl(0, F_SETFL, old_fd0_flags);
}

1084 1085 1086 1087 1088 1089
static void term_stdio_handler(int sig)
{
    /* restore echo after resume from suspend. */
    qemu_chr_set_echo_stdio(NULL, stdio_echo_state);
}

1090
static void qemu_chr_set_echo_stdio(CharDriverState *chr, bool echo)
A
aliguori 已提交
1091 1092 1093
{
    struct termios tty;

1094
    stdio_echo_state = echo;
1095
    tty = oldtty;
1096 1097
    if (!echo) {
        tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
A
aliguori 已提交
1098
                          |INLCR|IGNCR|ICRNL|IXON);
1099 1100 1101 1102 1103 1104 1105 1106
        tty.c_oflag |= OPOST;
        tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN);
        tty.c_cflag &= ~(CSIZE|PARENB);
        tty.c_cflag |= CS8;
        tty.c_cc[VMIN] = 1;
        tty.c_cc[VTIME] = 0;
    }
    if (!stdio_allow_signal)
A
aliguori 已提交
1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117
        tty.c_lflag &= ~ISIG;

    tcsetattr (0, TCSANOW, &tty);
}

static void qemu_chr_close_stdio(struct CharDriverState *chr)
{
    term_exit();
    fd_chr_close(chr);
}

1118 1119 1120 1121
static CharDriverState *qemu_chr_open_stdio(const char *id,
                                            ChardevBackend *backend,
                                            ChardevReturn *ret,
                                            Error **errp)
A
aliguori 已提交
1122
{
1123
    ChardevStdio *opts = backend->u.stdio;
A
aliguori 已提交
1124
    CharDriverState *chr;
1125
    struct sigaction act;
1126
    ChardevCommon *common = qapi_ChardevStdio_base(backend->u.stdio);
A
aliguori 已提交
1127

1128
    if (is_daemonized()) {
1129
        error_setg(errp, "cannot use stdio with -daemonize");
1130 1131
        return NULL;
    }
1132 1133

    if (stdio_in_use) {
1134 1135
        error_setg(errp, "cannot use stdio by multiple character devices");
        return NULL;
1136 1137 1138
    }

    stdio_in_use = true;
1139
    old_fd0_flags = fcntl(0, F_GETFL);
1140
    tcgetattr(0, &oldtty);
1141
    qemu_set_nonblock(0);
1142
    atexit(term_exit);
1143

1144 1145 1146 1147
    memset(&act, 0, sizeof(act));
    act.sa_handler = term_stdio_handler;
    sigaction(SIGCONT, &act, NULL);

1148
    chr = qemu_chr_open_fd(0, 1, common, errp);
A
aliguori 已提交
1149
    chr->chr_close = qemu_chr_close_stdio;
1150
    chr->chr_set_echo = qemu_chr_set_echo_stdio;
1151 1152 1153
    if (opts->has_signal) {
        stdio_allow_signal = opts->signal;
    }
1154
    qemu_chr_fe_set_echo(chr, false);
A
aliguori 已提交
1155

1156
    return chr;
A
aliguori 已提交
1157 1158 1159
}

#if defined(__linux__) || defined(__sun__) || defined(__FreeBSD__) \
A
Aurelien Jarno 已提交
1160 1161
    || defined(__NetBSD__) || defined(__OpenBSD__) || defined(__DragonFly__) \
    || defined(__GLIBC__)
A
aliguori 已提交
1162

P
Paolo Bonzini 已提交
1163 1164
#define HAVE_CHARDEV_SERIAL 1
#define HAVE_CHARDEV_PTY 1
1165

A
aliguori 已提交
1166
typedef struct {
1167
    QIOChannel *ioc;
A
aliguori 已提交
1168
    int read_bytes;
1169 1170 1171

    /* Protected by the CharDriverState chr_write_lock.  */
    int connected;
1172
    guint timer_tag;
1173
    guint open_tag;
1174
    int slave_fd;
A
aliguori 已提交
1175 1176
} PtyCharDriver;

1177
static void pty_chr_update_read_handler_locked(CharDriverState *chr);
A
aliguori 已提交
1178 1179
static void pty_chr_state(CharDriverState *chr, int connected);

1180 1181 1182 1183 1184
static gboolean pty_chr_timer(gpointer opaque)
{
    struct CharDriverState *chr = opaque;
    PtyCharDriver *s = chr->opaque;

1185
    qemu_mutex_lock(&chr->chr_write_lock);
1186
    s->timer_tag = 0;
1187
    s->open_tag = 0;
G
Gerd Hoffmann 已提交
1188 1189
    if (!s->connected) {
        /* Next poll ... */
1190
        pty_chr_update_read_handler_locked(chr);
G
Gerd Hoffmann 已提交
1191
    }
1192
    qemu_mutex_unlock(&chr->chr_write_lock);
1193 1194 1195
    return FALSE;
}

1196
/* Called with chr_write_lock held.  */
1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212
static void pty_chr_rearm_timer(CharDriverState *chr, int ms)
{
    PtyCharDriver *s = chr->opaque;

    if (s->timer_tag) {
        g_source_remove(s->timer_tag);
        s->timer_tag = 0;
    }

    if (ms == 1000) {
        s->timer_tag = g_timeout_add_seconds(1, pty_chr_timer, chr);
    } else {
        s->timer_tag = g_timeout_add(ms, pty_chr_timer, chr);
    }
}

1213 1214
/* Called with chr_write_lock held.  */
static void pty_chr_update_read_handler_locked(CharDriverState *chr)
1215 1216 1217
{
    PtyCharDriver *s = chr->opaque;
    GPollFD pfd;
P
Paolo Bonzini 已提交
1218
    int rc;
1219
    QIOChannelFile *fioc = QIO_CHANNEL_FILE(s->ioc);
1220

1221
    pfd.fd = fioc->fd;
1222 1223
    pfd.events = G_IO_OUT;
    pfd.revents = 0;
P
Paolo Bonzini 已提交
1224 1225 1226 1227 1228
    do {
        rc = g_poll(&pfd, 1, 0);
    } while (rc == -1 && errno == EINTR);
    assert(rc >= 0);

1229 1230 1231 1232 1233 1234 1235
    if (pfd.revents & G_IO_HUP) {
        pty_chr_state(chr, 0);
    } else {
        pty_chr_state(chr, 1);
    }
}

1236 1237 1238 1239 1240 1241 1242 1243
static void pty_chr_update_read_handler(CharDriverState *chr)
{
    qemu_mutex_lock(&chr->chr_write_lock);
    pty_chr_update_read_handler_locked(chr);
    qemu_mutex_unlock(&chr->chr_write_lock);
}

/* Called with chr_write_lock held.  */
A
aliguori 已提交
1244 1245 1246 1247 1248 1249
static int pty_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
{
    PtyCharDriver *s = chr->opaque;

    if (!s->connected) {
        /* guest sends data, check for (re-)connect */
1250
        pty_chr_update_read_handler_locked(chr);
1251 1252 1253
        if (!s->connected) {
            return 0;
        }
A
aliguori 已提交
1254
    }
1255
    return io_channel_send(s->ioc, buf, len);
A
aliguori 已提交
1256 1257
}

A
Anthony Liguori 已提交
1258 1259 1260
static GSource *pty_chr_add_watch(CharDriverState *chr, GIOCondition cond)
{
    PtyCharDriver *s = chr->opaque;
1261 1262 1263
    if (!s->connected) {
        return NULL;
    }
1264
    return qio_channel_create_watch(s->ioc, cond);
A
Anthony Liguori 已提交
1265 1266
}

A
aliguori 已提交
1267 1268 1269 1270 1271
static int pty_chr_read_poll(void *opaque)
{
    CharDriverState *chr = opaque;
    PtyCharDriver *s = chr->opaque;

1272
    s->read_bytes = qemu_chr_be_can_write(chr);
A
aliguori 已提交
1273 1274 1275
    return s->read_bytes;
}

1276
static gboolean pty_chr_read(QIOChannel *chan, GIOCondition cond, void *opaque)
A
aliguori 已提交
1277 1278 1279
{
    CharDriverState *chr = opaque;
    PtyCharDriver *s = chr->opaque;
1280
    gsize len;
1281
    uint8_t buf[READ_BUF_LEN];
1282
    ssize_t ret;
A
aliguori 已提交
1283 1284 1285 1286

    len = sizeof(buf);
    if (len > s->read_bytes)
        len = s->read_bytes;
1287 1288 1289
    if (len == 0) {
        return TRUE;
    }
1290 1291
    ret = qio_channel_read(s->ioc, (char *)buf, len, NULL);
    if (ret <= 0) {
A
aliguori 已提交
1292
        pty_chr_state(chr, 0);
1293 1294
        return FALSE;
    } else {
A
aliguori 已提交
1295
        pty_chr_state(chr, 1);
1296
        qemu_chr_be_write(chr, buf, ret);
A
aliguori 已提交
1297
    }
1298
    return TRUE;
A
aliguori 已提交
1299 1300
}

1301 1302 1303 1304 1305 1306 1307 1308 1309 1310
static gboolean qemu_chr_be_generic_open_func(gpointer opaque)
{
    CharDriverState *chr = opaque;
    PtyCharDriver *s = chr->opaque;

    s->open_tag = 0;
    qemu_chr_be_generic_open(chr);
    return FALSE;
}

1311
/* Called with chr_write_lock held.  */
A
aliguori 已提交
1312 1313 1314 1315 1316
static void pty_chr_state(CharDriverState *chr, int connected)
{
    PtyCharDriver *s = chr->opaque;

    if (!connected) {
1317 1318 1319 1320
        if (s->open_tag) {
            g_source_remove(s->open_tag);
            s->open_tag = 0;
        }
1321
        remove_fd_in_watch(chr);
A
aliguori 已提交
1322 1323 1324 1325
        s->connected = 0;
        /* (re-)connect poll interval for idle guests: once per second.
         * We check more frequently in case the guests sends data to
         * the virtual device linked to our pty. */
1326
        pty_chr_rearm_timer(chr, 1000);
A
aliguori 已提交
1327
    } else {
P
Paolo Bonzini 已提交
1328 1329 1330 1331 1332
        if (s->timer_tag) {
            g_source_remove(s->timer_tag);
            s->timer_tag = 0;
        }
        if (!s->connected) {
1333
            g_assert(s->open_tag == 0);
P
Paolo Bonzini 已提交
1334
            s->connected = 1;
1335
            s->open_tag = g_idle_add(qemu_chr_be_generic_open_func, chr);
1336 1337
        }
        if (!chr->fd_in_tag) {
1338 1339
            chr->fd_in_tag = io_add_watch_poll(s->ioc,
                                               pty_chr_read_poll,
1340
                                               pty_chr_read, chr);
P
Paolo Bonzini 已提交
1341
        }
A
aliguori 已提交
1342 1343 1344 1345 1346 1347 1348
    }
}

static void pty_chr_close(struct CharDriverState *chr)
{
    PtyCharDriver *s = chr->opaque;

1349 1350
    qemu_mutex_lock(&chr->chr_write_lock);
    pty_chr_state(chr, 0);
1351
    close(s->slave_fd);
1352
    object_unref(OBJECT(s->ioc));
1353 1354
    if (s->timer_tag) {
        g_source_remove(s->timer_tag);
1355
        s->timer_tag = 0;
1356
    }
1357
    qemu_mutex_unlock(&chr->chr_write_lock);
1358
    g_free(s);
1359
    qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
A
aliguori 已提交
1360 1361
}

G
Gerd Hoffmann 已提交
1362
static CharDriverState *qemu_chr_open_pty(const char *id,
1363 1364 1365
                                          ChardevBackend *backend,
                                          ChardevReturn *ret,
                                          Error **errp)
A
aliguori 已提交
1366 1367 1368
{
    CharDriverState *chr;
    PtyCharDriver *s;
G
Gerd Hoffmann 已提交
1369
    int master_fd, slave_fd;
A
aliguori 已提交
1370
    char pty_name[PATH_MAX];
1371
    ChardevCommon *common = qapi_ChardevDummy_base(backend->u.pty);
A
aliguori 已提交
1372

1373 1374
    master_fd = qemu_openpty_raw(&slave_fd, pty_name);
    if (master_fd < 0) {
1375
        error_setg_errno(errp, errno, "Failed to create PTY");
1376
        return NULL;
A
aliguori 已提交
1377 1378
    }

D
Don Slutz 已提交
1379
    qemu_set_nonblock(master_fd);
A
aliguori 已提交
1380

1381 1382 1383 1384 1385
    chr = qemu_chr_alloc(common, errp);
    if (!chr) {
        close(master_fd);
        return NULL;
    }
1386

1387 1388
    chr->filename = g_strdup_printf("pty:%s", pty_name);
    ret->pty = g_strdup(pty_name);
G
Gerd Hoffmann 已提交
1389
    ret->has_pty = true;
1390

G
Gerd Hoffmann 已提交
1391
    fprintf(stderr, "char device redirected to %s (label %s)\n",
1392
            pty_name, id);
A
aliguori 已提交
1393

1394
    s = g_new0(PtyCharDriver, 1);
A
aliguori 已提交
1395 1396 1397 1398
    chr->opaque = s;
    chr->chr_write = pty_chr_write;
    chr->chr_update_read_handler = pty_chr_update_read_handler;
    chr->chr_close = pty_chr_close;
A
Anthony Liguori 已提交
1399
    chr->chr_add_watch = pty_chr_add_watch;
1400
    chr->explicit_be_open = true;
A
aliguori 已提交
1401

1402
    s->ioc = QIO_CHANNEL(qio_channel_file_new_fd(master_fd));
1403
    s->slave_fd = slave_fd;
1404
    s->timer_tag = 0;
A
aliguori 已提交
1405

1406
    return chr;
A
aliguori 已提交
1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420
}

static void tty_serial_init(int fd, int speed,
                            int parity, int data_bits, int stop_bits)
{
    struct termios tty;
    speed_t spd;

#if 0
    printf("tty_serial_init: speed=%d parity=%c data=%d stop=%d\n",
           speed, parity, data_bits, stop_bits);
#endif
    tcgetattr (fd, &tty);

1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480
#define check_speed(val) if (speed <= val) { spd = B##val; break; }
    speed = speed * 10 / 11;
    do {
        check_speed(50);
        check_speed(75);
        check_speed(110);
        check_speed(134);
        check_speed(150);
        check_speed(200);
        check_speed(300);
        check_speed(600);
        check_speed(1200);
        check_speed(1800);
        check_speed(2400);
        check_speed(4800);
        check_speed(9600);
        check_speed(19200);
        check_speed(38400);
        /* Non-Posix values follow. They may be unsupported on some systems. */
        check_speed(57600);
        check_speed(115200);
#ifdef B230400
        check_speed(230400);
#endif
#ifdef B460800
        check_speed(460800);
#endif
#ifdef B500000
        check_speed(500000);
#endif
#ifdef B576000
        check_speed(576000);
#endif
#ifdef B921600
        check_speed(921600);
#endif
#ifdef B1000000
        check_speed(1000000);
#endif
#ifdef B1152000
        check_speed(1152000);
#endif
#ifdef B1500000
        check_speed(1500000);
#endif
#ifdef B2000000
        check_speed(2000000);
#endif
#ifdef B2500000
        check_speed(2500000);
#endif
#ifdef B3000000
        check_speed(3000000);
#endif
#ifdef B3500000
        check_speed(3500000);
#endif
#ifdef B4000000
        check_speed(4000000);
#endif
A
aliguori 已提交
1481
        spd = B115200;
1482
    } while (0);
A
aliguori 已提交
1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526

    cfsetispeed(&tty, spd);
    cfsetospeed(&tty, spd);

    tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
                          |INLCR|IGNCR|ICRNL|IXON);
    tty.c_oflag |= OPOST;
    tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN|ISIG);
    tty.c_cflag &= ~(CSIZE|PARENB|PARODD|CRTSCTS|CSTOPB);
    switch(data_bits) {
    default:
    case 8:
        tty.c_cflag |= CS8;
        break;
    case 7:
        tty.c_cflag |= CS7;
        break;
    case 6:
        tty.c_cflag |= CS6;
        break;
    case 5:
        tty.c_cflag |= CS5;
        break;
    }
    switch(parity) {
    default:
    case 'N':
        break;
    case 'E':
        tty.c_cflag |= PARENB;
        break;
    case 'O':
        tty.c_cflag |= PARENB | PARODD;
        break;
    }
    if (stop_bits == 2)
        tty.c_cflag |= CSTOPB;

    tcsetattr (fd, TCSANOW, &tty);
}

static int tty_serial_ioctl(CharDriverState *chr, int cmd, void *arg)
{
    FDCharDriver *s = chr->opaque;
1527
    QIOChannelFile *fioc = QIO_CHANNEL_FILE(s->ioc_in);
A
aliguori 已提交
1528 1529 1530 1531 1532

    switch(cmd) {
    case CHR_IOCTL_SERIAL_SET_PARAMS:
        {
            QEMUSerialSetParams *ssp = arg;
1533
            tty_serial_init(fioc->fd,
1534
                            ssp->speed, ssp->parity,
A
aliguori 已提交
1535 1536 1537 1538 1539 1540
                            ssp->data_bits, ssp->stop_bits);
        }
        break;
    case CHR_IOCTL_SERIAL_SET_BREAK:
        {
            int enable = *(int *)arg;
1541
            if (enable) {
1542
                tcsendbreak(fioc->fd, 1);
1543
            }
A
aliguori 已提交
1544 1545 1546 1547 1548 1549
        }
        break;
    case CHR_IOCTL_SERIAL_GET_TIOCM:
        {
            int sarg = 0;
            int *targ = (int *)arg;
1550
            ioctl(fioc->fd, TIOCMGET, &sarg);
A
aliguori 已提交
1551
            *targ = 0;
A
aurel32 已提交
1552
            if (sarg & TIOCM_CTS)
A
aliguori 已提交
1553
                *targ |= CHR_TIOCM_CTS;
A
aurel32 已提交
1554
            if (sarg & TIOCM_CAR)
A
aliguori 已提交
1555
                *targ |= CHR_TIOCM_CAR;
A
aurel32 已提交
1556
            if (sarg & TIOCM_DSR)
A
aliguori 已提交
1557
                *targ |= CHR_TIOCM_DSR;
A
aurel32 已提交
1558
            if (sarg & TIOCM_RI)
A
aliguori 已提交
1559
                *targ |= CHR_TIOCM_RI;
A
aurel32 已提交
1560
            if (sarg & TIOCM_DTR)
A
aliguori 已提交
1561
                *targ |= CHR_TIOCM_DTR;
A
aurel32 已提交
1562
            if (sarg & TIOCM_RTS)
A
aliguori 已提交
1563 1564 1565 1566 1567 1568 1569
                *targ |= CHR_TIOCM_RTS;
        }
        break;
    case CHR_IOCTL_SERIAL_SET_TIOCM:
        {
            int sarg = *(int *)arg;
            int targ = 0;
1570
            ioctl(fioc->fd, TIOCMGET, &targ);
A
aurel32 已提交
1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581
            targ &= ~(CHR_TIOCM_CTS | CHR_TIOCM_CAR | CHR_TIOCM_DSR
                     | CHR_TIOCM_RI | CHR_TIOCM_DTR | CHR_TIOCM_RTS);
            if (sarg & CHR_TIOCM_CTS)
                targ |= TIOCM_CTS;
            if (sarg & CHR_TIOCM_CAR)
                targ |= TIOCM_CAR;
            if (sarg & CHR_TIOCM_DSR)
                targ |= TIOCM_DSR;
            if (sarg & CHR_TIOCM_RI)
                targ |= TIOCM_RI;
            if (sarg & CHR_TIOCM_DTR)
A
aliguori 已提交
1582
                targ |= TIOCM_DTR;
A
aurel32 已提交
1583
            if (sarg & CHR_TIOCM_RTS)
A
aliguori 已提交
1584
                targ |= TIOCM_RTS;
1585
            ioctl(fioc->fd, TIOCMSET, &targ);
A
aliguori 已提交
1586 1587 1588 1589 1590 1591 1592 1593
        }
        break;
    default:
        return -ENOTSUP;
    }
    return 0;
}

1594 1595 1596 1597 1598
static void qemu_chr_close_tty(CharDriverState *chr)
{
    fd_chr_close(chr);
}

1599 1600 1601
static CharDriverState *qemu_chr_open_tty_fd(int fd,
                                             ChardevCommon *backend,
                                             Error **errp)
1602 1603 1604 1605
{
    CharDriverState *chr;

    tty_serial_init(fd, 115200, 'N', 8, 1);
1606
    chr = qemu_chr_open_fd(fd, fd, backend, errp);
1607 1608 1609 1610
    chr->chr_ioctl = tty_serial_ioctl;
    chr->chr_close = qemu_chr_close_tty;
    return chr;
}
A
aliguori 已提交
1611 1612 1613
#endif /* __linux__ || __sun__ */

#if defined(__linux__)
1614 1615 1616

#define HAVE_CHARDEV_PARPORT 1

A
aliguori 已提交
1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721
typedef struct {
    int fd;
    int mode;
} ParallelCharDriver;

static int pp_hw_mode(ParallelCharDriver *s, uint16_t mode)
{
    if (s->mode != mode) {
	int m = mode;
        if (ioctl(s->fd, PPSETMODE, &m) < 0)
            return 0;
	s->mode = mode;
    }
    return 1;
}

static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
{
    ParallelCharDriver *drv = chr->opaque;
    int fd = drv->fd;
    uint8_t b;

    switch(cmd) {
    case CHR_IOCTL_PP_READ_DATA:
        if (ioctl(fd, PPRDATA, &b) < 0)
            return -ENOTSUP;
        *(uint8_t *)arg = b;
        break;
    case CHR_IOCTL_PP_WRITE_DATA:
        b = *(uint8_t *)arg;
        if (ioctl(fd, PPWDATA, &b) < 0)
            return -ENOTSUP;
        break;
    case CHR_IOCTL_PP_READ_CONTROL:
        if (ioctl(fd, PPRCONTROL, &b) < 0)
            return -ENOTSUP;
	/* Linux gives only the lowest bits, and no way to know data
	   direction! For better compatibility set the fixed upper
	   bits. */
        *(uint8_t *)arg = b | 0xc0;
        break;
    case CHR_IOCTL_PP_WRITE_CONTROL:
        b = *(uint8_t *)arg;
        if (ioctl(fd, PPWCONTROL, &b) < 0)
            return -ENOTSUP;
        break;
    case CHR_IOCTL_PP_READ_STATUS:
        if (ioctl(fd, PPRSTATUS, &b) < 0)
            return -ENOTSUP;
        *(uint8_t *)arg = b;
        break;
    case CHR_IOCTL_PP_DATA_DIR:
        if (ioctl(fd, PPDATADIR, (int *)arg) < 0)
            return -ENOTSUP;
        break;
    case CHR_IOCTL_PP_EPP_READ_ADDR:
	if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
	    struct ParallelIOArg *parg = arg;
	    int n = read(fd, parg->buffer, parg->count);
	    if (n != parg->count) {
		return -EIO;
	    }
	}
        break;
    case CHR_IOCTL_PP_EPP_READ:
	if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
	    struct ParallelIOArg *parg = arg;
	    int n = read(fd, parg->buffer, parg->count);
	    if (n != parg->count) {
		return -EIO;
	    }
	}
        break;
    case CHR_IOCTL_PP_EPP_WRITE_ADDR:
	if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
	    struct ParallelIOArg *parg = arg;
	    int n = write(fd, parg->buffer, parg->count);
	    if (n != parg->count) {
		return -EIO;
	    }
	}
        break;
    case CHR_IOCTL_PP_EPP_WRITE:
	if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
	    struct ParallelIOArg *parg = arg;
	    int n = write(fd, parg->buffer, parg->count);
	    if (n != parg->count) {
		return -EIO;
	    }
	}
        break;
    default:
        return -ENOTSUP;
    }
    return 0;
}

static void pp_close(CharDriverState *chr)
{
    ParallelCharDriver *drv = chr->opaque;
    int fd = drv->fd;

    pp_hw_mode(drv, IEEE1284_MODE_COMPAT);
    ioctl(fd, PPRELEASE);
    close(fd);
1722
    g_free(drv);
1723
    qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
A
aliguori 已提交
1724 1725
}

1726 1727 1728
static CharDriverState *qemu_chr_open_pp_fd(int fd,
                                            ChardevCommon *backend,
                                            Error **errp)
A
aliguori 已提交
1729 1730 1731 1732 1733
{
    CharDriverState *chr;
    ParallelCharDriver *drv;

    if (ioctl(fd, PPCLAIM) < 0) {
1734
        error_setg_errno(errp, errno, "not a parallel port");
A
aliguori 已提交
1735
        close(fd);
1736
        return NULL;
A
aliguori 已提交
1737 1738
    }

1739 1740 1741 1742
    chr = qemu_chr_alloc(backend, errp);
    if (!chr) {
        return NULL;
    }
1743 1744 1745

    drv = g_new0(ParallelCharDriver, 1);
    chr->opaque = drv;
A
aliguori 已提交
1746 1747 1748
    chr->chr_write = null_chr_write;
    chr->chr_ioctl = pp_ioctl;
    chr->chr_close = pp_close;
1749 1750 1751

    drv->fd = fd;
    drv->mode = IEEE1284_MODE_COMPAT;
A
aliguori 已提交
1752

1753
    return chr;
A
aliguori 已提交
1754 1755 1756
}
#endif /* __linux__ */

A
Aurelien Jarno 已提交
1757
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__DragonFly__)
1758 1759 1760

#define HAVE_CHARDEV_PARPORT 1

1761 1762
static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
{
1763
    int fd = (int)(intptr_t)chr->opaque;
1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797
    uint8_t b;

    switch(cmd) {
    case CHR_IOCTL_PP_READ_DATA:
        if (ioctl(fd, PPIGDATA, &b) < 0)
            return -ENOTSUP;
        *(uint8_t *)arg = b;
        break;
    case CHR_IOCTL_PP_WRITE_DATA:
        b = *(uint8_t *)arg;
        if (ioctl(fd, PPISDATA, &b) < 0)
            return -ENOTSUP;
        break;
    case CHR_IOCTL_PP_READ_CONTROL:
        if (ioctl(fd, PPIGCTRL, &b) < 0)
            return -ENOTSUP;
        *(uint8_t *)arg = b;
        break;
    case CHR_IOCTL_PP_WRITE_CONTROL:
        b = *(uint8_t *)arg;
        if (ioctl(fd, PPISCTRL, &b) < 0)
            return -ENOTSUP;
        break;
    case CHR_IOCTL_PP_READ_STATUS:
        if (ioctl(fd, PPIGSTATUS, &b) < 0)
            return -ENOTSUP;
        *(uint8_t *)arg = b;
        break;
    default:
        return -ENOTSUP;
    }
    return 0;
}

1798 1799 1800
static CharDriverState *qemu_chr_open_pp_fd(int fd,
                                            ChardevBackend *backend,
                                            Error **errp)
1801 1802 1803
{
    CharDriverState *chr;

1804 1805 1806 1807
    chr = qemu_chr_alloc(common, errp);
    if (!chr) {
        return NULL;
    }
1808
    chr->opaque = (void *)(intptr_t)fd;
1809 1810
    chr->chr_write = null_chr_write;
    chr->chr_ioctl = pp_ioctl;
1811
    chr->explicit_be_open = true;
1812
    return chr;
1813 1814 1815
}
#endif

A
aliguori 已提交
1816 1817
#else /* _WIN32 */

P
Paolo Bonzini 已提交
1818 1819
#define HAVE_CHARDEV_SERIAL 1

A
aliguori 已提交
1820 1821 1822
typedef struct {
    int max_size;
    HANDLE hcom, hrecv, hsend;
1823
    OVERLAPPED orecv;
A
aliguori 已提交
1824 1825
    BOOL fpipe;
    DWORD len;
1826 1827 1828

    /* Protected by the CharDriverState chr_write_lock.  */
    OVERLAPPED osend;
A
aliguori 已提交
1829 1830
} WinCharState;

F
Fabien Chouteau 已提交
1831 1832 1833 1834 1835 1836 1837 1838
typedef struct {
    HANDLE  hStdIn;
    HANDLE  hInputReadyEvent;
    HANDLE  hInputDoneEvent;
    HANDLE  hInputThread;
    uint8_t win_stdio_buf;
} WinStdioCharState;

A
aliguori 已提交
1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866
#define NSENDBUF 2048
#define NRECVBUF 2048
#define MAXCONNECT 1
#define NTIMEOUT 5000

static int win_chr_poll(void *opaque);
static int win_chr_pipe_poll(void *opaque);

static void win_chr_close(CharDriverState *chr)
{
    WinCharState *s = chr->opaque;

    if (s->hsend) {
        CloseHandle(s->hsend);
        s->hsend = NULL;
    }
    if (s->hrecv) {
        CloseHandle(s->hrecv);
        s->hrecv = NULL;
    }
    if (s->hcom) {
        CloseHandle(s->hcom);
        s->hcom = NULL;
    }
    if (s->fpipe)
        qemu_del_polling_cb(win_chr_pipe_poll, chr);
    else
        qemu_del_polling_cb(win_chr_poll, chr);
1867

1868
    qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
A
aliguori 已提交
1869 1870
}

1871
static int win_chr_init(CharDriverState *chr, const char *filename, Error **errp)
A
aliguori 已提交
1872 1873 1874 1875 1876 1877 1878 1879 1880 1881
{
    WinCharState *s = chr->opaque;
    COMMCONFIG comcfg;
    COMMTIMEOUTS cto = { 0, 0, 0, 0, 0};
    COMSTAT comstat;
    DWORD size;
    DWORD err;

    s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
    if (!s->hsend) {
1882
        error_setg(errp, "Failed CreateEvent");
A
aliguori 已提交
1883 1884 1885 1886
        goto fail;
    }
    s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
    if (!s->hrecv) {
1887
        error_setg(errp, "Failed CreateEvent");
A
aliguori 已提交
1888 1889 1890 1891 1892 1893
        goto fail;
    }

    s->hcom = CreateFile(filename, GENERIC_READ|GENERIC_WRITE, 0, NULL,
                      OPEN_EXISTING, FILE_FLAG_OVERLAPPED, 0);
    if (s->hcom == INVALID_HANDLE_VALUE) {
1894
        error_setg(errp, "Failed CreateFile (%lu)", GetLastError());
A
aliguori 已提交
1895 1896 1897 1898 1899
        s->hcom = NULL;
        goto fail;
    }

    if (!SetupComm(s->hcom, NRECVBUF, NSENDBUF)) {
1900
        error_setg(errp, "Failed SetupComm");
A
aliguori 已提交
1901 1902 1903 1904 1905 1906 1907 1908 1909 1910
        goto fail;
    }

    ZeroMemory(&comcfg, sizeof(COMMCONFIG));
    size = sizeof(COMMCONFIG);
    GetDefaultCommConfig(filename, &comcfg, &size);
    comcfg.dcb.DCBlength = sizeof(DCB);
    CommConfigDialog(filename, NULL, &comcfg);

    if (!SetCommState(s->hcom, &comcfg.dcb)) {
1911
        error_setg(errp, "Failed SetCommState");
A
aliguori 已提交
1912 1913 1914 1915
        goto fail;
    }

    if (!SetCommMask(s->hcom, EV_ERR)) {
1916
        error_setg(errp, "Failed SetCommMask");
A
aliguori 已提交
1917 1918 1919 1920 1921
        goto fail;
    }

    cto.ReadIntervalTimeout = MAXDWORD;
    if (!SetCommTimeouts(s->hcom, &cto)) {
1922
        error_setg(errp, "Failed SetCommTimeouts");
A
aliguori 已提交
1923 1924 1925 1926
        goto fail;
    }

    if (!ClearCommError(s->hcom, &err, &comstat)) {
1927
        error_setg(errp, "Failed ClearCommError");
A
aliguori 已提交
1928 1929 1930 1931 1932 1933 1934 1935 1936 1937
        goto fail;
    }
    qemu_add_polling_cb(win_chr_poll, chr);
    return 0;

 fail:
    win_chr_close(chr);
    return -1;
}

1938
/* Called with chr_write_lock held.  */
A
aliguori 已提交
1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976
static int win_chr_write(CharDriverState *chr, const uint8_t *buf, int len1)
{
    WinCharState *s = chr->opaque;
    DWORD len, ret, size, err;

    len = len1;
    ZeroMemory(&s->osend, sizeof(s->osend));
    s->osend.hEvent = s->hsend;
    while (len > 0) {
        if (s->hsend)
            ret = WriteFile(s->hcom, buf, len, &size, &s->osend);
        else
            ret = WriteFile(s->hcom, buf, len, &size, NULL);
        if (!ret) {
            err = GetLastError();
            if (err == ERROR_IO_PENDING) {
                ret = GetOverlappedResult(s->hcom, &s->osend, &size, TRUE);
                if (ret) {
                    buf += size;
                    len -= size;
                } else {
                    break;
                }
            } else {
                break;
            }
        } else {
            buf += size;
            len -= size;
        }
    }
    return len1 - len;
}

static int win_chr_read_poll(CharDriverState *chr)
{
    WinCharState *s = chr->opaque;

1977
    s->max_size = qemu_chr_be_can_write(chr);
A
aliguori 已提交
1978 1979 1980 1981 1982 1983 1984
    return s->max_size;
}

static void win_chr_readfile(CharDriverState *chr)
{
    WinCharState *s = chr->opaque;
    int ret, err;
1985
    uint8_t buf[READ_BUF_LEN];
A
aliguori 已提交
1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998
    DWORD size;

    ZeroMemory(&s->orecv, sizeof(s->orecv));
    s->orecv.hEvent = s->hrecv;
    ret = ReadFile(s->hcom, buf, s->len, &size, &s->orecv);
    if (!ret) {
        err = GetLastError();
        if (err == ERROR_IO_PENDING) {
            ret = GetOverlappedResult(s->hcom, &s->orecv, &size, TRUE);
        }
    }

    if (size > 0) {
1999
        qemu_chr_be_write(chr, buf, size);
A
aliguori 已提交
2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031
    }
}

static void win_chr_read(CharDriverState *chr)
{
    WinCharState *s = chr->opaque;

    if (s->len > s->max_size)
        s->len = s->max_size;
    if (s->len == 0)
        return;

    win_chr_readfile(chr);
}

static int win_chr_poll(void *opaque)
{
    CharDriverState *chr = opaque;
    WinCharState *s = chr->opaque;
    COMSTAT status;
    DWORD comerr;

    ClearCommError(s->hcom, &comerr, &status);
    if (status.cbInQue > 0) {
        s->len = status.cbInQue;
        win_chr_read_poll(chr);
        win_chr_read(chr);
        return 1;
    }
    return 0;
}

2032
static CharDriverState *qemu_chr_open_win_path(const char *filename,
2033
                                               ChardevCommon *backend,
2034
                                               Error **errp)
A
aliguori 已提交
2035 2036 2037 2038
{
    CharDriverState *chr;
    WinCharState *s;

2039 2040 2041 2042
    chr = qemu_chr_alloc(backend, errp);
    if (!chr) {
        return NULL;
    }
2043
    s = g_new0(WinCharState, 1);
A
aliguori 已提交
2044 2045 2046 2047
    chr->opaque = s;
    chr->chr_write = win_chr_write;
    chr->chr_close = win_chr_close;

2048
    if (win_chr_init(chr, filename, errp) < 0) {
2049
        g_free(s);
2050
        qemu_chr_free_common(chr);
2051
        return NULL;
A
aliguori 已提交
2052
    }
2053
    return chr;
A
aliguori 已提交
2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071
}

static int win_chr_pipe_poll(void *opaque)
{
    CharDriverState *chr = opaque;
    WinCharState *s = chr->opaque;
    DWORD size;

    PeekNamedPipe(s->hcom, NULL, 0, NULL, &size, NULL);
    if (size > 0) {
        s->len = size;
        win_chr_read_poll(chr);
        win_chr_read(chr);
        return 1;
    }
    return 0;
}

2072 2073
static int win_chr_pipe_init(CharDriverState *chr, const char *filename,
                             Error **errp)
A
aliguori 已提交
2074 2075 2076 2077 2078
{
    WinCharState *s = chr->opaque;
    OVERLAPPED ov;
    int ret;
    DWORD size;
2079
    char *openname;
A
aliguori 已提交
2080 2081 2082 2083 2084

    s->fpipe = TRUE;

    s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
    if (!s->hsend) {
2085
        error_setg(errp, "Failed CreateEvent");
A
aliguori 已提交
2086 2087 2088 2089
        goto fail;
    }
    s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
    if (!s->hrecv) {
2090
        error_setg(errp, "Failed CreateEvent");
A
aliguori 已提交
2091 2092 2093
        goto fail;
    }

2094
    openname = g_strdup_printf("\\\\.\\pipe\\%s", filename);
A
aliguori 已提交
2095 2096 2097 2098
    s->hcom = CreateNamedPipe(openname, PIPE_ACCESS_DUPLEX | FILE_FLAG_OVERLAPPED,
                              PIPE_TYPE_BYTE | PIPE_READMODE_BYTE |
                              PIPE_WAIT,
                              MAXCONNECT, NSENDBUF, NRECVBUF, NTIMEOUT, NULL);
2099
    g_free(openname);
A
aliguori 已提交
2100
    if (s->hcom == INVALID_HANDLE_VALUE) {
2101
        error_setg(errp, "Failed CreateNamedPipe (%lu)", GetLastError());
A
aliguori 已提交
2102 2103 2104 2105 2106 2107 2108 2109
        s->hcom = NULL;
        goto fail;
    }

    ZeroMemory(&ov, sizeof(ov));
    ov.hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
    ret = ConnectNamedPipe(s->hcom, &ov);
    if (ret) {
2110
        error_setg(errp, "Failed ConnectNamedPipe");
A
aliguori 已提交
2111 2112 2113 2114 2115
        goto fail;
    }

    ret = GetOverlappedResult(s->hcom, &ov, &size, TRUE);
    if (!ret) {
2116
        error_setg(errp, "Failed GetOverlappedResult");
A
aliguori 已提交
2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136
        if (ov.hEvent) {
            CloseHandle(ov.hEvent);
            ov.hEvent = NULL;
        }
        goto fail;
    }

    if (ov.hEvent) {
        CloseHandle(ov.hEvent);
        ov.hEvent = NULL;
    }
    qemu_add_polling_cb(win_chr_pipe_poll, chr);
    return 0;

 fail:
    win_chr_close(chr);
    return -1;
}


2137 2138 2139 2140
static CharDriverState *qemu_chr_open_pipe(const char *id,
                                           ChardevBackend *backend,
                                           ChardevReturn *ret,
                                           Error **errp)
A
aliguori 已提交
2141
{
2142
    ChardevHostdev *opts = backend->u.pipe;
2143
    const char *filename = opts->device;
A
aliguori 已提交
2144 2145
    CharDriverState *chr;
    WinCharState *s;
2146
    ChardevCommon *common = qapi_ChardevHostdev_base(backend->u.pipe);
A
aliguori 已提交
2147

2148 2149 2150 2151
    chr = qemu_chr_alloc(common, errp);
    if (!chr) {
        return NULL;
    }
2152
    s = g_new0(WinCharState, 1);
A
aliguori 已提交
2153 2154 2155 2156
    chr->opaque = s;
    chr->chr_write = win_chr_write;
    chr->chr_close = win_chr_close;

2157
    if (win_chr_pipe_init(chr, filename, errp) < 0) {
2158
        g_free(s);
2159
        qemu_chr_free_common(chr);
2160
        return NULL;
A
aliguori 已提交
2161
    }
2162
    return chr;
A
aliguori 已提交
2163 2164
}

2165 2166 2167
static CharDriverState *qemu_chr_open_win_file(HANDLE fd_out,
                                               ChardevCommon *backend,
                                               Error **errp)
A
aliguori 已提交
2168 2169 2170 2171
{
    CharDriverState *chr;
    WinCharState *s;

2172 2173 2174 2175
    chr = qemu_chr_alloc(backend, errp);
    if (!chr) {
        return NULL;
    }
2176
    s = g_new0(WinCharState, 1);
A
aliguori 已提交
2177 2178 2179
    s->hcom = fd_out;
    chr->opaque = s;
    chr->chr_write = win_chr_write;
2180
    return chr;
A
aliguori 已提交
2181 2182
}

2183 2184 2185 2186
static CharDriverState *qemu_chr_open_win_con(const char *id,
                                              ChardevBackend *backend,
                                              ChardevReturn *ret,
                                              Error **errp)
A
aliguori 已提交
2187
{
2188 2189 2190
    ChardevCommon *common = qapi_ChardevDummy_base(backend->u.console);
    return qemu_chr_open_win_file(GetStdHandle(STD_OUTPUT_HANDLE),
                                  common, errp);
A
aliguori 已提交
2191 2192
}

F
Fabien Chouteau 已提交
2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220
static int win_stdio_write(CharDriverState *chr, const uint8_t *buf, int len)
{
    HANDLE  hStdOut = GetStdHandle(STD_OUTPUT_HANDLE);
    DWORD   dwSize;
    int     len1;

    len1 = len;

    while (len1 > 0) {
        if (!WriteFile(hStdOut, buf, len1, &dwSize, NULL)) {
            break;
        }
        buf  += dwSize;
        len1 -= dwSize;
    }

    return len - len1;
}

static void win_stdio_wait_func(void *opaque)
{
    CharDriverState   *chr   = opaque;
    WinStdioCharState *stdio = chr->opaque;
    INPUT_RECORD       buf[4];
    int                ret;
    DWORD              dwSize;
    int                i;

2221
    ret = ReadConsoleInput(stdio->hStdIn, buf, ARRAY_SIZE(buf), &dwSize);
F
Fabien Chouteau 已提交
2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328

    if (!ret) {
        /* Avoid error storm */
        qemu_del_wait_object(stdio->hStdIn, NULL, NULL);
        return;
    }

    for (i = 0; i < dwSize; i++) {
        KEY_EVENT_RECORD *kev = &buf[i].Event.KeyEvent;

        if (buf[i].EventType == KEY_EVENT && kev->bKeyDown) {
            int j;
            if (kev->uChar.AsciiChar != 0) {
                for (j = 0; j < kev->wRepeatCount; j++) {
                    if (qemu_chr_be_can_write(chr)) {
                        uint8_t c = kev->uChar.AsciiChar;
                        qemu_chr_be_write(chr, &c, 1);
                    }
                }
            }
        }
    }
}

static DWORD WINAPI win_stdio_thread(LPVOID param)
{
    CharDriverState   *chr   = param;
    WinStdioCharState *stdio = chr->opaque;
    int                ret;
    DWORD              dwSize;

    while (1) {

        /* Wait for one byte */
        ret = ReadFile(stdio->hStdIn, &stdio->win_stdio_buf, 1, &dwSize, NULL);

        /* Exit in case of error, continue if nothing read */
        if (!ret) {
            break;
        }
        if (!dwSize) {
            continue;
        }

        /* Some terminal emulator returns \r\n for Enter, just pass \n */
        if (stdio->win_stdio_buf == '\r') {
            continue;
        }

        /* Signal the main thread and wait until the byte was eaten */
        if (!SetEvent(stdio->hInputReadyEvent)) {
            break;
        }
        if (WaitForSingleObject(stdio->hInputDoneEvent, INFINITE)
            != WAIT_OBJECT_0) {
            break;
        }
    }

    qemu_del_wait_object(stdio->hInputReadyEvent, NULL, NULL);
    return 0;
}

static void win_stdio_thread_wait_func(void *opaque)
{
    CharDriverState   *chr   = opaque;
    WinStdioCharState *stdio = chr->opaque;

    if (qemu_chr_be_can_write(chr)) {
        qemu_chr_be_write(chr, &stdio->win_stdio_buf, 1);
    }

    SetEvent(stdio->hInputDoneEvent);
}

static void qemu_chr_set_echo_win_stdio(CharDriverState *chr, bool echo)
{
    WinStdioCharState *stdio  = chr->opaque;
    DWORD              dwMode = 0;

    GetConsoleMode(stdio->hStdIn, &dwMode);

    if (echo) {
        SetConsoleMode(stdio->hStdIn, dwMode | ENABLE_ECHO_INPUT);
    } else {
        SetConsoleMode(stdio->hStdIn, dwMode & ~ENABLE_ECHO_INPUT);
    }
}

static void win_stdio_close(CharDriverState *chr)
{
    WinStdioCharState *stdio = chr->opaque;

    if (stdio->hInputReadyEvent != INVALID_HANDLE_VALUE) {
        CloseHandle(stdio->hInputReadyEvent);
    }
    if (stdio->hInputDoneEvent != INVALID_HANDLE_VALUE) {
        CloseHandle(stdio->hInputDoneEvent);
    }
    if (stdio->hInputThread != INVALID_HANDLE_VALUE) {
        TerminateThread(stdio->hInputThread, 0);
    }

    g_free(chr->opaque);
    g_free(chr);
}

2329 2330 2331 2332
static CharDriverState *qemu_chr_open_stdio(const char *id,
                                            ChardevBackend *backend,
                                            ChardevReturn *ret,
                                            Error **errp)
F
Fabien Chouteau 已提交
2333 2334 2335 2336 2337
{
    CharDriverState   *chr;
    WinStdioCharState *stdio;
    DWORD              dwMode;
    int                is_console = 0;
2338
    ChardevCommon *common = qapi_ChardevStdio_base(backend->u.stdio);
F
Fabien Chouteau 已提交
2339

2340 2341 2342 2343
    chr   = qemu_chr_alloc(common, errp);
    if (!chr) {
        return NULL;
    }
2344
    stdio = g_new0(WinStdioCharState, 1);
F
Fabien Chouteau 已提交
2345 2346 2347

    stdio->hStdIn = GetStdHandle(STD_INPUT_HANDLE);
    if (stdio->hStdIn == INVALID_HANDLE_VALUE) {
2348 2349
        error_setg(errp, "cannot open stdio: invalid handle");
        return NULL;
F
Fabien Chouteau 已提交
2350 2351 2352 2353 2354 2355 2356 2357
    }

    is_console = GetConsoleMode(stdio->hStdIn, &dwMode) != 0;

    chr->opaque    = stdio;
    chr->chr_write = win_stdio_write;
    chr->chr_close = win_stdio_close;

2358 2359 2360
    if (is_console) {
        if (qemu_add_wait_object(stdio->hStdIn,
                                 win_stdio_wait_func, chr)) {
2361 2362
            error_setg(errp, "qemu_add_wait_object: failed");
            goto err1;
2363 2364 2365 2366 2367 2368
        }
    } else {
        DWORD   dwId;
            
        stdio->hInputReadyEvent = CreateEvent(NULL, FALSE, FALSE, NULL);
        stdio->hInputDoneEvent  = CreateEvent(NULL, FALSE, FALSE, NULL);
2369
        if (stdio->hInputReadyEvent == INVALID_HANDLE_VALUE
2370
            || stdio->hInputDoneEvent == INVALID_HANDLE_VALUE) {
2371 2372
            error_setg(errp, "cannot create event");
            goto err2;
2373 2374 2375
        }
        if (qemu_add_wait_object(stdio->hInputReadyEvent,
                                 win_stdio_thread_wait_func, chr)) {
2376 2377 2378 2379 2380 2381 2382 2383 2384
            error_setg(errp, "qemu_add_wait_object: failed");
            goto err2;
        }
        stdio->hInputThread     = CreateThread(NULL, 0, win_stdio_thread,
                                               chr, 0, &dwId);

        if (stdio->hInputThread == INVALID_HANDLE_VALUE) {
            error_setg(errp, "cannot create stdio thread");
            goto err3;
F
Fabien Chouteau 已提交
2385 2386 2387 2388 2389
        }
    }

    dwMode |= ENABLE_LINE_INPUT;

2390
    if (is_console) {
F
Fabien Chouteau 已提交
2391 2392 2393 2394 2395 2396 2397 2398 2399 2400
        /* set the terminal in raw mode */
        /* ENABLE_QUICK_EDIT_MODE | ENABLE_EXTENDED_FLAGS */
        dwMode |= ENABLE_PROCESSED_INPUT;
    }

    SetConsoleMode(stdio->hStdIn, dwMode);

    chr->chr_set_echo = qemu_chr_set_echo_win_stdio;
    qemu_chr_fe_set_echo(chr, false);

2401
    return chr;
2402 2403 2404 2405 2406 2407 2408 2409 2410

err3:
    qemu_del_wait_object(stdio->hInputReadyEvent, NULL, NULL);
err2:
    CloseHandle(stdio->hInputReadyEvent);
    CloseHandle(stdio->hInputDoneEvent);
err1:
    qemu_del_wait_object(stdio->hStdIn, NULL, NULL);
    return NULL;
F
Fabien Chouteau 已提交
2411
}
A
aliguori 已提交
2412 2413
#endif /* !_WIN32 */

2414

A
aliguori 已提交
2415 2416 2417 2418
/***********************************************************/
/* UDP Net console */

typedef struct {
2419
    QIOChannel *ioc;
2420
    uint8_t buf[READ_BUF_LEN];
A
aliguori 已提交
2421 2422 2423 2424 2425
    int bufcnt;
    int bufptr;
    int max_size;
} NetCharDriver;

2426
/* Called with chr_write_lock held.  */
A
aliguori 已提交
2427 2428 2429
static int udp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
{
    NetCharDriver *s = chr->opaque;
2430

2431 2432
    return qio_channel_write(
        s->ioc, (const char *)buf, len, NULL);
A
aliguori 已提交
2433 2434 2435 2436 2437 2438 2439
}

static int udp_chr_read_poll(void *opaque)
{
    CharDriverState *chr = opaque;
    NetCharDriver *s = chr->opaque;

2440
    s->max_size = qemu_chr_be_can_write(chr);
A
aliguori 已提交
2441 2442 2443 2444 2445

    /* If there were any stray characters in the queue process them
     * first
     */
    while (s->max_size > 0 && s->bufptr < s->bufcnt) {
2446
        qemu_chr_be_write(chr, &s->buf[s->bufptr], 1);
A
aliguori 已提交
2447
        s->bufptr++;
2448
        s->max_size = qemu_chr_be_can_write(chr);
A
aliguori 已提交
2449 2450 2451 2452
    }
    return s->max_size;
}

2453
static gboolean udp_chr_read(QIOChannel *chan, GIOCondition cond, void *opaque)
A
aliguori 已提交
2454 2455 2456
{
    CharDriverState *chr = opaque;
    NetCharDriver *s = chr->opaque;
2457
    ssize_t ret;
A
aliguori 已提交
2458

2459 2460 2461
    if (s->max_size == 0) {
        return TRUE;
    }
2462 2463 2464
    ret = qio_channel_read(
        s->ioc, (char *)s->buf, sizeof(s->buf), NULL);
    if (ret <= 0) {
2465
        remove_fd_in_watch(chr);
2466 2467
        return FALSE;
    }
2468
    s->bufcnt = ret;
A
aliguori 已提交
2469 2470 2471

    s->bufptr = 0;
    while (s->max_size > 0 && s->bufptr < s->bufcnt) {
2472
        qemu_chr_be_write(chr, &s->buf[s->bufptr], 1);
A
aliguori 已提交
2473
        s->bufptr++;
2474
        s->max_size = qemu_chr_be_can_write(chr);
A
aliguori 已提交
2475
    }
2476 2477

    return TRUE;
A
aliguori 已提交
2478 2479 2480 2481 2482 2483
}

static void udp_chr_update_read_handler(CharDriverState *chr)
{
    NetCharDriver *s = chr->opaque;

2484
    remove_fd_in_watch(chr);
2485 2486 2487
    if (s->ioc) {
        chr->fd_in_tag = io_add_watch_poll(s->ioc,
                                           udp_chr_read_poll,
2488
                                           udp_chr_read, chr);
A
aliguori 已提交
2489 2490 2491
    }
}

2492 2493 2494
static void udp_chr_close(CharDriverState *chr)
{
    NetCharDriver *s = chr->opaque;
2495 2496

    remove_fd_in_watch(chr);
2497 2498
    if (s->ioc) {
        object_unref(OBJECT(s->ioc));
2499
    }
2500
    g_free(s);
2501
    qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
2502 2503
}

2504 2505 2506
static CharDriverState *qemu_chr_open_udp(QIOChannelSocket *sioc,
                                          ChardevCommon *backend,
                                          Error **errp)
A
aliguori 已提交
2507 2508 2509 2510
{
    CharDriverState *chr = NULL;
    NetCharDriver *s = NULL;

2511 2512 2513 2514
    chr = qemu_chr_alloc(backend, errp);
    if (!chr) {
        return NULL;
    }
2515
    s = g_new0(NetCharDriver, 1);
A
aliguori 已提交
2516

2517
    s->ioc = QIO_CHANNEL(sioc);
A
aliguori 已提交
2518 2519 2520 2521 2522
    s->bufcnt = 0;
    s->bufptr = 0;
    chr->opaque = s;
    chr->chr_write = udp_chr_write;
    chr->chr_update_read_handler = udp_chr_update_read_handler;
2523
    chr->chr_close = udp_chr_close;
2524 2525
    /* be isn't opened until we get a connection */
    chr->explicit_be_open = true;
2526
    return chr;
G
Gerd Hoffmann 已提交
2527
}
A
aliguori 已提交
2528 2529 2530 2531 2532

/***********************************************************/
/* TCP Net console */

typedef struct {
2533 2534
    QIOChannel *ioc; /* Client I/O channel */
    QIOChannelSocket *sioc; /* Client master channel */
2535
    QIOChannelSocket *listen_ioc;
2536
    guint listen_tag;
2537
    QCryptoTLSCreds *tls_creds;
A
aliguori 已提交
2538 2539 2540 2541 2542
    int connected;
    int max_size;
    int do_telnetopt;
    int do_nodelay;
    int is_unix;
2543
    int *read_msgfds;
2544
    size_t read_msgfds_num;
2545
    int *write_msgfds;
2546
    size_t write_msgfds_num;
2547 2548 2549 2550

    SocketAddress *addr;
    bool is_listen;
    bool is_telnet;
2551 2552 2553

    guint reconnect_timer;
    int64_t reconnect_time;
2554
    bool connect_err_reported;
A
aliguori 已提交
2555 2556
} TCPCharDriver;

2557 2558 2559 2560 2561 2562 2563 2564 2565 2566
static gboolean socket_reconnect_timeout(gpointer opaque);

static void qemu_chr_socket_restart_timer(CharDriverState *chr)
{
    TCPCharDriver *s = chr->opaque;
    assert(s->connected == 0);
    s->reconnect_timer = g_timeout_add_seconds(s->reconnect_time,
                                               socket_reconnect_timeout, chr);
}

2567 2568 2569 2570 2571 2572 2573 2574 2575 2576 2577 2578 2579
static void check_report_connect_error(CharDriverState *chr,
                                       Error *err)
{
    TCPCharDriver *s = chr->opaque;

    if (!s->connect_err_reported) {
        error_report("Unable to connect character device %s: %s",
                     chr->label, error_get_pretty(err));
        s->connect_err_reported = true;
    }
    qemu_chr_socket_restart_timer(chr);
}

2580 2581 2582
static gboolean tcp_chr_accept(QIOChannel *chan,
                               GIOCondition cond,
                               void *opaque);
2583

2584
/* Called with chr_write_lock held.  */
A
aliguori 已提交
2585 2586 2587 2588
static int tcp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
{
    TCPCharDriver *s = chr->opaque;
    if (s->connected) {
2589 2590 2591 2592 2593 2594 2595 2596 2597
        int ret =  io_channel_send_full(s->ioc, buf, len,
                                        s->write_msgfds,
                                        s->write_msgfds_num);

        /* free the written msgfds, no matter what */
        if (s->write_msgfds_num) {
            g_free(s->write_msgfds);
            s->write_msgfds = 0;
            s->write_msgfds_num = 0;
2598
        }
2599 2600

        return ret;
2601
    } else {
2602
        /* XXX: indicate an error ? */
2603
        return len;
A
aliguori 已提交
2604 2605 2606 2607 2608 2609 2610 2611 2612
    }
}

static int tcp_chr_read_poll(void *opaque)
{
    CharDriverState *chr = opaque;
    TCPCharDriver *s = chr->opaque;
    if (!s->connected)
        return 0;
2613
    s->max_size = qemu_chr_be_can_write(chr);
A
aliguori 已提交
2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645
    return s->max_size;
}

#define IAC 255
#define IAC_BREAK 243
static void tcp_chr_process_IAC_bytes(CharDriverState *chr,
                                      TCPCharDriver *s,
                                      uint8_t *buf, int *size)
{
    /* Handle any telnet client's basic IAC options to satisfy char by
     * char mode with no echo.  All IAC options will be removed from
     * the buf and the do_telnetopt variable will be used to track the
     * state of the width of the IAC information.
     *
     * IAC commands come in sets of 3 bytes with the exception of the
     * "IAC BREAK" command and the double IAC.
     */

    int i;
    int j = 0;

    for (i = 0; i < *size; i++) {
        if (s->do_telnetopt > 1) {
            if ((unsigned char)buf[i] == IAC && s->do_telnetopt == 2) {
                /* Double IAC means send an IAC */
                if (j != i)
                    buf[j] = buf[i];
                j++;
                s->do_telnetopt = 1;
            } else {
                if ((unsigned char)buf[i] == IAC_BREAK && s->do_telnetopt == 2) {
                    /* Handle IAC break commands by sending a serial break */
2646
                    qemu_chr_be_event(chr, CHR_EVENT_BREAK);
A
aliguori 已提交
2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662 2663 2664 2665 2666
                    s->do_telnetopt++;
                }
                s->do_telnetopt++;
            }
            if (s->do_telnetopt >= 4) {
                s->do_telnetopt = 1;
            }
        } else {
            if ((unsigned char)buf[i] == IAC) {
                s->do_telnetopt = 2;
            } else {
                if (j != i)
                    buf[j] = buf[i];
                j++;
            }
        }
    }
    *size = j;
}

2667
static int tcp_get_msgfds(CharDriverState *chr, int *fds, int num)
2668 2669
{
    TCPCharDriver *s = chr->opaque;
2670 2671
    int to_copy = (s->read_msgfds_num < num) ? s->read_msgfds_num : num;

M
Michael S. Tsirkin 已提交
2672 2673
    assert(num <= TCP_MAX_FDS);

2674
    if (to_copy) {
2675 2676
        int i;

2677 2678
        memcpy(fds, s->read_msgfds, to_copy * sizeof(int));

2679 2680 2681 2682 2683
        /* Close unused fds */
        for (i = to_copy; i < s->read_msgfds_num; i++) {
            close(s->read_msgfds[i]);
        }

2684 2685 2686 2687 2688 2689
        g_free(s->read_msgfds);
        s->read_msgfds = 0;
        s->read_msgfds_num = 0;
    }

    return to_copy;
2690 2691
}

2692 2693 2694 2695
static int tcp_set_msgfds(CharDriverState *chr, int *fds, int num)
{
    TCPCharDriver *s = chr->opaque;

2696 2697 2698 2699
    if (!qio_channel_has_feature(s->ioc,
                                 QIO_CHANNEL_FEATURE_FD_PASS)) {
        return -1;
    }
2700
    /* clear old pending fd array */
2701
    g_free(s->write_msgfds);
2702 2703

    if (num) {
2704
        s->write_msgfds = g_new(int, num);
2705 2706 2707 2708 2709 2710 2711 2712
        memcpy(s->write_msgfds, fds, num * sizeof(int));
    }

    s->write_msgfds_num = num;

    return 0;
}

2713
static ssize_t tcp_chr_recv(CharDriverState *chr, char *buf, size_t len)
2714 2715
{
    TCPCharDriver *s = chr->opaque;
2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730
    struct iovec iov = { .iov_base = buf, .iov_len = len };
    int ret;
    size_t i;
    int *msgfds = NULL;
    size_t msgfds_num = 0;

    if (qio_channel_has_feature(s->ioc, QIO_CHANNEL_FEATURE_FD_PASS)) {
        ret = qio_channel_readv_full(s->ioc, &iov, 1,
                                     &msgfds, &msgfds_num,
                                     NULL);
    } else {
        ret = qio_channel_readv_full(s->ioc, &iov, 1,
                                     NULL, NULL,
                                     NULL);
    }
2731

2732
    if (msgfds_num) {
2733 2734 2735 2736
        /* close and clean read_msgfds */
        for (i = 0; i < s->read_msgfds_num; i++) {
            close(s->read_msgfds[i]);
        }
2737

2738 2739 2740 2741
        if (s->read_msgfds_num) {
            g_free(s->read_msgfds);
        }

2742 2743
        s->read_msgfds = msgfds;
        s->read_msgfds_num = msgfds_num;
2744 2745
    }

2746 2747 2748 2749 2750
    for (i = 0; i < s->read_msgfds_num; i++) {
        int fd = s->read_msgfds[i];
        if (fd < 0) {
            continue;
        }
2751

2752 2753
        /* O_NONBLOCK is preserved across SCM_RIGHTS so reset it */
        qemu_set_block(fd);
2754

2755 2756
#ifndef MSG_CMSG_CLOEXEC
        qemu_set_cloexec(fd);
2757 2758
#endif
    }
2759

2760
    return ret;
2761 2762
}

2763 2764 2765
static GSource *tcp_chr_add_watch(CharDriverState *chr, GIOCondition cond)
{
    TCPCharDriver *s = chr->opaque;
2766
    return qio_channel_create_watch(s->ioc, cond);
2767 2768
}

2769 2770 2771 2772 2773
static void tcp_chr_disconnect(CharDriverState *chr)
{
    TCPCharDriver *s = chr->opaque;

    s->connected = 0;
2774 2775 2776
    if (s->listen_ioc) {
        s->listen_tag = qio_channel_add_watch(
            QIO_CHANNEL(s->listen_ioc), G_IO_IN, tcp_chr_accept, chr, NULL);
2777 2778
    }
    remove_fd_in_watch(chr);
2779 2780
    object_unref(OBJECT(s->sioc));
    s->sioc = NULL;
2781 2782
    object_unref(OBJECT(s->ioc));
    s->ioc = NULL;
2783 2784 2785
    g_free(chr->filename);
    chr->filename = SocketAddress_to_str("disconnected:", s->addr,
                                         s->is_listen, s->is_telnet);
2786
    qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
2787 2788 2789
    if (s->reconnect_time) {
        qemu_chr_socket_restart_timer(chr);
    }
2790 2791
}

2792
static gboolean tcp_chr_read(QIOChannel *chan, GIOCondition cond, void *opaque)
A
aliguori 已提交
2793 2794 2795
{
    CharDriverState *chr = opaque;
    TCPCharDriver *s = chr->opaque;
2796
    uint8_t buf[READ_BUF_LEN];
A
aliguori 已提交
2797 2798
    int len, size;

2799
    if (!s->connected || s->max_size <= 0) {
2800
        return TRUE;
2801
    }
A
aliguori 已提交
2802 2803 2804
    len = sizeof(buf);
    if (len > s->max_size)
        len = s->max_size;
2805
    size = tcp_chr_recv(chr, (void *)buf, len);
2806
    if (size == 0 || size == -1) {
A
aliguori 已提交
2807
        /* connection closed */
2808
        tcp_chr_disconnect(chr);
A
aliguori 已提交
2809 2810 2811 2812
    } else if (size > 0) {
        if (s->do_telnetopt)
            tcp_chr_process_IAC_bytes(chr, s, buf, &size);
        if (size > 0)
2813
            qemu_chr_be_write(chr, buf, size);
A
aliguori 已提交
2814
    }
2815 2816

    return TRUE;
A
aliguori 已提交
2817 2818
}

2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835 2836
static int tcp_chr_sync_read(CharDriverState *chr, const uint8_t *buf, int len)
{
    TCPCharDriver *s = chr->opaque;
    int size;

    if (!s->connected) {
        return 0;
    }

    size = tcp_chr_recv(chr, (void *) buf, len);
    if (size == 0) {
        /* connection closed */
        tcp_chr_disconnect(chr);
    }

    return size;
}

A
aliguori 已提交
2837 2838 2839 2840
static void tcp_chr_connect(void *opaque)
{
    CharDriverState *chr = opaque;
    TCPCharDriver *s = chr->opaque;
2841

2842
    g_free(chr->filename);
2843 2844 2845 2846
    chr->filename = sockaddr_to_str(
        &s->sioc->localAddr, s->sioc->localAddrLen,
        &s->sioc->remoteAddr, s->sioc->remoteAddrLen,
        s->is_listen, s->is_telnet);
A
aliguori 已提交
2847 2848

    s->connected = 1;
2849 2850 2851
    if (s->ioc) {
        chr->fd_in_tag = io_add_watch_poll(s->ioc,
                                           tcp_chr_read_poll,
2852
                                           tcp_chr_read, chr);
2853
    }
2854
    qemu_chr_be_generic_open(chr);
A
aliguori 已提交
2855 2856
}

2857 2858 2859 2860
static void tcp_chr_update_read_handler(CharDriverState *chr)
{
    TCPCharDriver *s = chr->opaque;

2861 2862 2863 2864
    if (!s->connected) {
        return;
    }

2865
    remove_fd_in_watch(chr);
2866 2867 2868
    if (s->ioc) {
        chr->fd_in_tag = io_add_watch_poll(s->ioc,
                                           tcp_chr_read_poll,
2869 2870 2871 2872
                                           tcp_chr_read, chr);
    }
}

2873 2874 2875 2876 2877 2878 2879 2880 2881
typedef struct {
    CharDriverState *chr;
    char buf[12];
    size_t buflen;
} TCPCharDriverTelnetInit;

static gboolean tcp_chr_telnet_init_io(QIOChannel *ioc,
                                       GIOCondition cond G_GNUC_UNUSED,
                                       gpointer user_data)
A
aliguori 已提交
2882
{
2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921 2922 2923 2924 2925 2926 2927 2928 2929 2930 2931 2932 2933 2934 2935 2936
    TCPCharDriverTelnetInit *init = user_data;
    ssize_t ret;

    ret = qio_channel_write(ioc, init->buf, init->buflen, NULL);
    if (ret < 0) {
        if (ret == QIO_CHANNEL_ERR_BLOCK) {
            ret = 0;
        } else {
            tcp_chr_disconnect(init->chr);
            return FALSE;
        }
    }
    init->buflen -= ret;

    if (init->buflen == 0) {
        tcp_chr_connect(init->chr);
        return FALSE;
    }

    memmove(init->buf, init->buf + ret, init->buflen);

    return TRUE;
}

static void tcp_chr_telnet_init(CharDriverState *chr)
{
    TCPCharDriver *s = chr->opaque;
    TCPCharDriverTelnetInit *init =
        g_new0(TCPCharDriverTelnetInit, 1);
    size_t n = 0;

    init->chr = chr;
    init->buflen = 12;

#define IACSET(x, a, b, c)                      \
    do {                                        \
        x[n++] = a;                             \
        x[n++] = b;                             \
        x[n++] = c;                             \
    } while (0)

    /* Prep the telnet negotion to put telnet in binary,
     * no echo, single char mode */
    IACSET(init->buf, 0xff, 0xfb, 0x01);  /* IAC WILL ECHO */
    IACSET(init->buf, 0xff, 0xfb, 0x03);  /* IAC WILL Suppress go ahead */
    IACSET(init->buf, 0xff, 0xfb, 0x00);  /* IAC WILL Binary */
    IACSET(init->buf, 0xff, 0xfd, 0x00);  /* IAC DO Binary */

#undef IACSET

    qio_channel_add_watch(
        s->ioc, G_IO_OUT,
        tcp_chr_telnet_init_io,
        init, NULL);
A
aliguori 已提交
2937 2938
}

2939 2940 2941 2942 2943 2944 2945 2946 2947 2948 2949 2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965 2966 2967 2968 2969 2970 2971 2972 2973 2974 2975 2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989

static void tcp_chr_tls_handshake(Object *source,
                                  Error *err,
                                  gpointer user_data)
{
    CharDriverState *chr = user_data;
    TCPCharDriver *s = chr->opaque;

    if (err) {
        tcp_chr_disconnect(chr);
    } else {
        if (s->do_telnetopt) {
            tcp_chr_telnet_init(chr);
        } else {
            tcp_chr_connect(chr);
        }
    }
}


static void tcp_chr_tls_init(CharDriverState *chr)
{
    TCPCharDriver *s = chr->opaque;
    QIOChannelTLS *tioc;
    Error *err = NULL;

    if (s->is_listen) {
        tioc = qio_channel_tls_new_server(
            s->ioc, s->tls_creds,
            NULL, /* XXX Use an ACL */
            &err);
    } else {
        tioc = qio_channel_tls_new_client(
            s->ioc, s->tls_creds,
            s->addr->u.inet->host,
            &err);
    }
    if (tioc == NULL) {
        error_free(err);
        tcp_chr_disconnect(chr);
    }
    object_unref(OBJECT(s->ioc));
    s->ioc = QIO_CHANNEL(tioc);

    qio_channel_tls_handshake(tioc,
                              tcp_chr_tls_handshake,
                              chr,
                              NULL);
}


2990
static int tcp_chr_new_client(CharDriverState *chr, QIOChannelSocket *sioc)
2991 2992
{
    TCPCharDriver *s = chr->opaque;
2993
    if (s->ioc != NULL) {
2994
	return -1;
2995
    }
2996

2997 2998
    s->ioc = QIO_CHANNEL(sioc);
    object_ref(OBJECT(sioc));
2999 3000
    s->sioc = sioc;
    object_ref(OBJECT(sioc));
3001 3002 3003 3004

    if (s->do_nodelay) {
        qio_channel_set_delay(s->ioc, false);
    }
3005 3006 3007 3008
    if (s->listen_tag) {
        g_source_remove(s->listen_tag);
        s->listen_tag = 0;
    }
3009

3010 3011
    if (s->tls_creds) {
        tcp_chr_tls_init(chr);
3012
    } else {
3013 3014 3015 3016 3017
        if (s->do_telnetopt) {
            tcp_chr_telnet_init(chr);
        } else {
            tcp_chr_connect(chr);
        }
3018
    }
3019 3020 3021 3022

    return 0;
}

3023 3024 3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038 3039 3040 3041

static int tcp_chr_add_client(CharDriverState *chr, int fd)
{
    int ret;
    QIOChannelSocket *sioc;

    sioc = qio_channel_socket_new_fd(fd, NULL);
    if (!sioc) {
        return -1;
    }
    qio_channel_set_blocking(QIO_CHANNEL(sioc), false, NULL);
    ret = tcp_chr_new_client(chr, sioc);
    object_unref(OBJECT(sioc));
    return ret;
}

static gboolean tcp_chr_accept(QIOChannel *channel,
                               GIOCondition cond,
                               void *opaque)
A
aliguori 已提交
3042 3043
{
    CharDriverState *chr = opaque;
3044
    QIOChannelSocket *sioc;
A
aliguori 已提交
3045

3046 3047 3048 3049
    sioc = qio_channel_socket_accept(QIO_CHANNEL_SOCKET(channel),
                                     NULL);
    if (!sioc) {
        return TRUE;
A
aliguori 已提交
3050
    }
3051 3052 3053 3054

    tcp_chr_new_client(chr, sioc);

    object_unref(OBJECT(sioc));
3055 3056

    return TRUE;
A
aliguori 已提交
3057 3058 3059 3060 3061
}

static void tcp_chr_close(CharDriverState *chr)
{
    TCPCharDriver *s = chr->opaque;
3062
    int i;
3063

3064 3065 3066 3067
    if (s->reconnect_timer) {
        g_source_remove(s->reconnect_timer);
        s->reconnect_timer = 0;
    }
3068
    qapi_free_SocketAddress(s->addr);
3069 3070 3071
    remove_fd_in_watch(chr);
    if (s->ioc) {
        object_unref(OBJECT(s->ioc));
3072
    }
3073 3074 3075 3076 3077 3078
    if (s->listen_tag) {
        g_source_remove(s->listen_tag);
        s->listen_tag = 0;
    }
    if (s->listen_ioc) {
        object_unref(OBJECT(s->listen_ioc));
3079
    }
3080 3081 3082 3083 3084 3085
    if (s->read_msgfds_num) {
        for (i = 0; i < s->read_msgfds_num; i++) {
            close(s->read_msgfds[i]);
        }
        g_free(s->read_msgfds);
    }
3086 3087 3088
    if (s->tls_creds) {
        object_unref(OBJECT(s->tls_creds));
    }
3089 3090 3091
    if (s->write_msgfds_num) {
        g_free(s->write_msgfds);
    }
3092
    g_free(s);
3093
    qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
A
aliguori 已提交
3094 3095
}

3096 3097
static void qemu_chr_finish_socket_connection(CharDriverState *chr,
                                              QIOChannelSocket *sioc)
A
aliguori 已提交
3098
{
3099
    TCPCharDriver *s = chr->opaque;
3100

3101
    if (s->is_listen) {
3102 3103 3104
        s->listen_ioc = sioc;
        s->listen_tag = qio_channel_add_watch(
            QIO_CHANNEL(s->listen_ioc), G_IO_IN, tcp_chr_accept, chr, NULL);
3105
    } else {
3106 3107
        tcp_chr_new_client(chr, sioc);
        object_unref(OBJECT(sioc));
3108
    }
3109 3110
}

3111
static void qemu_chr_socket_connected(Object *src, Error *err, void *opaque)
3112
{
3113
    QIOChannelSocket *sioc = QIO_CHANNEL_SOCKET(src);
3114
    CharDriverState *chr = opaque;
3115
    TCPCharDriver *s = chr->opaque;
3116

3117
    if (err) {
3118
        check_report_connect_error(chr, err);
3119
        object_unref(src);
3120 3121 3122
        return;
    }

3123
    s->connect_err_reported = false;
3124
    qemu_chr_finish_socket_connection(chr, sioc);
3125 3126
}

3127
static bool qemu_chr_open_socket_fd(CharDriverState *chr, Error **errp)
3128
{
3129
    TCPCharDriver *s = chr->opaque;
3130
    QIOChannelSocket *sioc = qio_channel_socket_new();
3131

3132
    if (s->is_listen) {
3133 3134 3135 3136
        if (qio_channel_socket_listen_sync(sioc, s->addr, errp) < 0) {
            goto fail;
        }
        qemu_chr_finish_socket_connection(chr, sioc);
3137
    } else if (s->reconnect_time) {
3138 3139 3140
        qio_channel_socket_connect_async(sioc, s->addr,
                                         qemu_chr_socket_connected,
                                         chr, NULL);
3141
    } else {
3142 3143 3144 3145
        if (qio_channel_socket_connect_sync(sioc, s->addr, errp) < 0) {
            goto fail;
        }
        qemu_chr_finish_socket_connection(chr, sioc);
3146 3147
    }

3148
    return true;
3149 3150 3151 3152

 fail:
    object_unref(OBJECT(sioc));
    return false;
3153 3154
}

3155
/*********************************************************/
3156
/* Ring buffer chardev */
3157 3158 3159 3160 3161 3162

typedef struct {
    size_t size;
    size_t prod;
    size_t cons;
    uint8_t *cbuf;
3163
} RingBufCharDriver;
3164

3165
static size_t ringbuf_count(const CharDriverState *chr)
3166
{
3167
    const RingBufCharDriver *d = chr->opaque;
3168

3169
    return d->prod - d->cons;
3170 3171
}

3172
/* Called with chr_write_lock held.  */
3173
static int ringbuf_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
3174
{
3175
    RingBufCharDriver *d = chr->opaque;
3176 3177 3178 3179 3180 3181 3182
    int i;

    if (!buf || (len < 0)) {
        return -1;
    }

    for (i = 0; i < len; i++ ) {
3183 3184
        d->cbuf[d->prod++ & (d->size - 1)] = buf[i];
        if (d->prod - d->cons > d->size) {
3185 3186 3187 3188 3189 3190 3191
            d->cons = d->prod - d->size;
        }
    }

    return 0;
}

3192
static int ringbuf_chr_read(CharDriverState *chr, uint8_t *buf, int len)
3193
{
3194
    RingBufCharDriver *d = chr->opaque;
3195 3196
    int i;

3197
    qemu_mutex_lock(&chr->chr_write_lock);
3198 3199
    for (i = 0; i < len && d->cons != d->prod; i++) {
        buf[i] = d->cbuf[d->cons++ & (d->size - 1)];
3200
    }
3201
    qemu_mutex_unlock(&chr->chr_write_lock);
3202 3203 3204 3205

    return i;
}

3206
static void ringbuf_chr_close(struct CharDriverState *chr)
3207
{
3208
    RingBufCharDriver *d = chr->opaque;
3209 3210 3211 3212 3213 3214

    g_free(d->cbuf);
    g_free(d);
    chr->opaque = NULL;
}

3215 3216 3217
static CharDriverState *qemu_chr_open_ringbuf(const char *id,
                                              ChardevBackend *backend,
                                              ChardevReturn *ret,
3218
                                              Error **errp)
3219
{
3220
    ChardevRingbuf *opts = backend->u.ringbuf;
3221
    ChardevCommon *common = qapi_ChardevRingbuf_base(backend->u.ringbuf);
3222
    CharDriverState *chr;
3223
    RingBufCharDriver *d;
3224

3225 3226 3227 3228
    chr = qemu_chr_alloc(common, errp);
    if (!chr) {
        return NULL;
    }
3229 3230
    d = g_malloc(sizeof(*d));

3231
    d->size = opts->has_size ? opts->size : 65536;
3232 3233 3234

    /* The size must be power of 2 */
    if (d->size & (d->size - 1)) {
3235
        error_setg(errp, "size of ringbuf chardev must be power of two");
3236 3237 3238 3239 3240 3241 3242 3243
        goto fail;
    }

    d->prod = 0;
    d->cons = 0;
    d->cbuf = g_malloc0(d->size);

    chr->opaque = d;
3244 3245
    chr->chr_write = ringbuf_chr_write;
    chr->chr_close = ringbuf_chr_close;
3246 3247 3248 3249 3250

    return chr;

fail:
    g_free(d);
3251
    qemu_chr_free_common(chr);
3252 3253 3254
    return NULL;
}

3255
bool chr_is_ringbuf(const CharDriverState *chr)
3256
{
3257
    return chr->chr_write == ringbuf_chr_write;
3258 3259
}

3260
void qmp_ringbuf_write(const char *device, const char *data,
3261
                       bool has_format, enum DataFormat format,
3262 3263 3264
                       Error **errp)
{
    CharDriverState *chr;
3265
    const uint8_t *write_data;
3266
    int ret;
3267
    gsize write_count;
3268 3269 3270

    chr = qemu_chr_find(device);
    if (!chr) {
3271
        error_setg(errp, "Device '%s' not found", device);
3272 3273 3274
        return;
    }

3275 3276
    if (!chr_is_ringbuf(chr)) {
        error_setg(errp,"%s is not a ringbuf device", device);
3277 3278 3279 3280
        return;
    }

    if (has_format && (format == DATA_FORMAT_BASE64)) {
3281 3282 3283 3284 3285 3286
        write_data = qbase64_decode(data, -1,
                                    &write_count,
                                    errp);
        if (!write_data) {
            return;
        }
3287 3288
    } else {
        write_data = (uint8_t *)data;
3289
        write_count = strlen(data);
3290 3291
    }

3292
    ret = ringbuf_chr_write(chr, write_data, write_count);
3293

3294 3295 3296 3297
    if (write_data != (uint8_t *)data) {
        g_free((void *)write_data);
    }

3298 3299 3300 3301 3302 3303
    if (ret < 0) {
        error_setg(errp, "Failed to write to device %s", device);
        return;
    }
}

3304
char *qmp_ringbuf_read(const char *device, int64_t size,
3305 3306
                       bool has_format, enum DataFormat format,
                       Error **errp)
3307 3308
{
    CharDriverState *chr;
3309
    uint8_t *read_data;
3310
    size_t count;
3311
    char *data;
3312 3313 3314

    chr = qemu_chr_find(device);
    if (!chr) {
3315
        error_setg(errp, "Device '%s' not found", device);
3316 3317 3318
        return NULL;
    }

3319 3320
    if (!chr_is_ringbuf(chr)) {
        error_setg(errp,"%s is not a ringbuf device", device);
3321 3322 3323 3324 3325 3326 3327 3328
        return NULL;
    }

    if (size <= 0) {
        error_setg(errp, "size must be greater than zero");
        return NULL;
    }

3329
    count = ringbuf_count(chr);
3330
    size = size > count ? count : size;
3331
    read_data = g_malloc(size + 1);
3332

3333
    ringbuf_chr_read(chr, read_data, size);
3334 3335

    if (has_format && (format == DATA_FORMAT_BASE64)) {
3336
        data = g_base64_encode(read_data, size);
3337
        g_free(read_data);
3338
    } else {
3339 3340 3341 3342 3343 3344 3345
        /*
         * FIXME should read only complete, valid UTF-8 characters up
         * to @size bytes.  Invalid sequences should be replaced by a
         * suitable replacement character.  Except when (and only
         * when) ring buffer lost characters since last read, initial
         * continuation characters should be dropped.
         */
3346
        read_data[size] = 0;
3347
        data = (char *)read_data;
3348 3349
    }

3350
    return data;
3351 3352
}

G
Gerd Hoffmann 已提交
3353
QemuOpts *qemu_chr_parse_compat(const char *label, const char *filename)
3354
{
G
Gerd Hoffmann 已提交
3355
    char host[65], port[33], width[8], height[8];
3356
    int pos;
3357
    const char *p;
3358
    QemuOpts *opts;
3359
    Error *local_err = NULL;
3360

3361
    opts = qemu_opts_create(qemu_find_opts("chardev"), label, 1, &local_err);
3362
    if (local_err) {
3363
        error_report_err(local_err);
3364
        return NULL;
3365
    }
3366

G
Gerd Hoffmann 已提交
3367 3368
    if (strstart(filename, "mon:", &p)) {
        filename = p;
3369
        qemu_opt_set(opts, "mux", "on", &error_abort);
3370 3371 3372 3373 3374 3375
        if (strcmp(filename, "stdio") == 0) {
            /* Monitor is muxed to stdio: do not exit on Ctrl+C by default
             * but pass it to the guest.  Handle this only for compat syntax,
             * for -chardev syntax we have special option for this.
             * This is what -nographic did, redirecting+muxing serial+monitor
             * to stdio causing Ctrl+C to be passed to guest. */
3376
            qemu_opt_set(opts, "signal", "off", &error_abort);
3377
        }
G
Gerd Hoffmann 已提交
3378 3379
    }

3380 3381 3382
    if (strcmp(filename, "null")    == 0 ||
        strcmp(filename, "pty")     == 0 ||
        strcmp(filename, "msmouse") == 0 ||
3383
        strcmp(filename, "braille") == 0 ||
P
Paolo Bonzini 已提交
3384
        strcmp(filename, "testdev") == 0 ||
3385
        strcmp(filename, "stdio")   == 0) {
3386
        qemu_opt_set(opts, "backend", filename, &error_abort);
3387 3388
        return opts;
    }
G
Gerd Hoffmann 已提交
3389
    if (strstart(filename, "vc", &p)) {
3390
        qemu_opt_set(opts, "backend", "vc", &error_abort);
G
Gerd Hoffmann 已提交
3391
        if (*p == ':') {
3392
            if (sscanf(p+1, "%7[0-9]x%7[0-9]", width, height) == 2) {
G
Gerd Hoffmann 已提交
3393
                /* pixels */
3394 3395
                qemu_opt_set(opts, "width", width, &error_abort);
                qemu_opt_set(opts, "height", height, &error_abort);
3396
            } else if (sscanf(p+1, "%7[0-9]Cx%7[0-9]C", width, height) == 2) {
G
Gerd Hoffmann 已提交
3397
                /* chars */
3398 3399
                qemu_opt_set(opts, "cols", width, &error_abort);
                qemu_opt_set(opts, "rows", height, &error_abort);
G
Gerd Hoffmann 已提交
3400 3401 3402 3403 3404 3405
            } else {
                goto fail;
            }
        }
        return opts;
    }
3406
    if (strcmp(filename, "con:") == 0) {
3407
        qemu_opt_set(opts, "backend", "console", &error_abort);
3408 3409
        return opts;
    }
3410
    if (strstart(filename, "COM", NULL)) {
3411 3412
        qemu_opt_set(opts, "backend", "serial", &error_abort);
        qemu_opt_set(opts, "path", filename, &error_abort);
3413 3414
        return opts;
    }
3415
    if (strstart(filename, "file:", &p)) {
3416 3417
        qemu_opt_set(opts, "backend", "file", &error_abort);
        qemu_opt_set(opts, "path", p, &error_abort);
3418 3419 3420
        return opts;
    }
    if (strstart(filename, "pipe:", &p)) {
3421 3422
        qemu_opt_set(opts, "backend", "pipe", &error_abort);
        qemu_opt_set(opts, "path", p, &error_abort);
3423 3424
        return opts;
    }
3425 3426 3427 3428 3429 3430 3431
    if (strstart(filename, "tcp:", &p) ||
        strstart(filename, "telnet:", &p)) {
        if (sscanf(p, "%64[^:]:%32[^,]%n", host, port, &pos) < 2) {
            host[0] = 0;
            if (sscanf(p, ":%32[^,]%n", port, &pos) < 1)
                goto fail;
        }
3432 3433 3434
        qemu_opt_set(opts, "backend", "socket", &error_abort);
        qemu_opt_set(opts, "host", host, &error_abort);
        qemu_opt_set(opts, "port", port, &error_abort);
3435
        if (p[pos] == ',') {
3436 3437 3438
            qemu_opts_do_parse(opts, p+pos+1, NULL, &local_err);
            if (local_err) {
                error_report_err(local_err);
3439
                goto fail;
3440
            }
3441 3442
        }
        if (strstart(filename, "telnet:", &p))
3443
            qemu_opt_set(opts, "telnet", "on", &error_abort);
3444 3445
        return opts;
    }
G
Gerd Hoffmann 已提交
3446
    if (strstart(filename, "udp:", &p)) {
3447
        qemu_opt_set(opts, "backend", "udp", &error_abort);
G
Gerd Hoffmann 已提交
3448 3449
        if (sscanf(p, "%64[^:]:%32[^@,]%n", host, port, &pos) < 2) {
            host[0] = 0;
3450
            if (sscanf(p, ":%32[^@,]%n", port, &pos) < 1) {
G
Gerd Hoffmann 已提交
3451 3452 3453
                goto fail;
            }
        }
3454 3455
        qemu_opt_set(opts, "host", host, &error_abort);
        qemu_opt_set(opts, "port", port, &error_abort);
G
Gerd Hoffmann 已提交
3456 3457 3458 3459 3460 3461 3462 3463
        if (p[pos] == '@') {
            p += pos + 1;
            if (sscanf(p, "%64[^:]:%32[^,]%n", host, port, &pos) < 2) {
                host[0] = 0;
                if (sscanf(p, ":%32[^,]%n", port, &pos) < 1) {
                    goto fail;
                }
            }
3464 3465
            qemu_opt_set(opts, "localaddr", host, &error_abort);
            qemu_opt_set(opts, "localport", port, &error_abort);
G
Gerd Hoffmann 已提交
3466 3467 3468
        }
        return opts;
    }
3469
    if (strstart(filename, "unix:", &p)) {
3470
        qemu_opt_set(opts, "backend", "socket", &error_abort);
3471 3472 3473
        qemu_opts_do_parse(opts, p, "path", &local_err);
        if (local_err) {
            error_report_err(local_err);
3474
            goto fail;
3475
        }
3476 3477
        return opts;
    }
3478 3479
    if (strstart(filename, "/dev/parport", NULL) ||
        strstart(filename, "/dev/ppi", NULL)) {
3480 3481
        qemu_opt_set(opts, "backend", "parport", &error_abort);
        qemu_opt_set(opts, "path", filename, &error_abort);
3482 3483 3484
        return opts;
    }
    if (strstart(filename, "/dev/", NULL)) {
3485 3486
        qemu_opt_set(opts, "backend", "tty", &error_abort);
        qemu_opt_set(opts, "path", filename, &error_abort);
3487 3488
        return opts;
    }
3489

3490
fail:
3491 3492 3493 3494
    qemu_opts_del(opts);
    return NULL;
}

3495 3496 3497 3498 3499 3500 3501 3502 3503 3504 3505 3506
static void qemu_chr_parse_common(QemuOpts *opts, ChardevCommon *backend)
{
    const char *logfile = qemu_opt_get(opts, "logfile");

    backend->has_logfile = logfile != NULL;
    backend->logfile = logfile ? g_strdup(logfile) : NULL;

    backend->has_logappend = true;
    backend->logappend = qemu_opt_get_bool(opts, "logappend", false);
}


3507 3508 3509 3510 3511 3512 3513 3514 3515
static void qemu_chr_parse_file_out(QemuOpts *opts, ChardevBackend *backend,
                                    Error **errp)
{
    const char *path = qemu_opt_get(opts, "path");

    if (path == NULL) {
        error_setg(errp, "chardev: file: no filename given");
        return;
    }
3516
    backend->u.file = g_new0(ChardevFile, 1);
3517
    qemu_chr_parse_common(opts, qapi_ChardevFile_base(backend->u.file));
3518
    backend->u.file->out = g_strdup(path);
3519 3520 3521

    backend->u.file->has_append = true;
    backend->u.file->append = qemu_opt_get_bool(opts, "append", false);
3522 3523
}

3524 3525 3526
static void qemu_chr_parse_stdio(QemuOpts *opts, ChardevBackend *backend,
                                 Error **errp)
{
3527
    backend->u.stdio = g_new0(ChardevStdio, 1);
3528
    qemu_chr_parse_common(opts, qapi_ChardevStdio_base(backend->u.stdio));
3529 3530
    backend->u.stdio->has_signal = true;
    backend->u.stdio->signal = qemu_opt_get_bool(opts, "signal", true);
3531 3532
}

3533
#ifdef HAVE_CHARDEV_SERIAL
3534 3535 3536 3537 3538 3539 3540 3541 3542
static void qemu_chr_parse_serial(QemuOpts *opts, ChardevBackend *backend,
                                  Error **errp)
{
    const char *device = qemu_opt_get(opts, "path");

    if (device == NULL) {
        error_setg(errp, "chardev: serial/tty: no device path given");
        return;
    }
3543
    backend->u.serial = g_new0(ChardevHostdev, 1);
3544
    qemu_chr_parse_common(opts, qapi_ChardevHostdev_base(backend->u.serial));
3545
    backend->u.serial->device = g_strdup(device);
3546
}
3547
#endif
3548

3549
#ifdef HAVE_CHARDEV_PARPORT
3550 3551 3552 3553 3554 3555 3556 3557 3558
static void qemu_chr_parse_parallel(QemuOpts *opts, ChardevBackend *backend,
                                    Error **errp)
{
    const char *device = qemu_opt_get(opts, "path");

    if (device == NULL) {
        error_setg(errp, "chardev: parallel: no device path given");
        return;
    }
3559
    backend->u.parallel = g_new0(ChardevHostdev, 1);
3560
    qemu_chr_parse_common(opts, qapi_ChardevHostdev_base(backend->u.parallel));
3561
    backend->u.parallel->device = g_strdup(device);
3562
}
3563
#endif
3564

3565 3566 3567 3568 3569 3570 3571 3572 3573
static void qemu_chr_parse_pipe(QemuOpts *opts, ChardevBackend *backend,
                                Error **errp)
{
    const char *device = qemu_opt_get(opts, "path");

    if (device == NULL) {
        error_setg(errp, "chardev: pipe: no device path given");
        return;
    }
3574
    backend->u.pipe = g_new0(ChardevHostdev, 1);
3575
    qemu_chr_parse_common(opts, qapi_ChardevHostdev_base(backend->u.pipe));
3576
    backend->u.pipe->device = g_strdup(device);
3577 3578
}

3579 3580
static void qemu_chr_parse_ringbuf(QemuOpts *opts, ChardevBackend *backend,
                                   Error **errp)
3581 3582 3583
{
    int val;

3584
    backend->u.ringbuf = g_new0(ChardevRingbuf, 1);
3585
    qemu_chr_parse_common(opts, qapi_ChardevRingbuf_base(backend->u.ringbuf));
3586

3587
    val = qemu_opt_get_size(opts, "size", 0);
3588
    if (val != 0) {
3589 3590
        backend->u.ringbuf->has_size = true;
        backend->u.ringbuf->size = val;
3591 3592 3593
    }
}

3594 3595 3596 3597 3598 3599 3600 3601 3602
static void qemu_chr_parse_mux(QemuOpts *opts, ChardevBackend *backend,
                               Error **errp)
{
    const char *chardev = qemu_opt_get(opts, "chardev");

    if (chardev == NULL) {
        error_setg(errp, "chardev: mux: no chardev given");
        return;
    }
3603
    backend->u.mux = g_new0(ChardevMux, 1);
3604
    qemu_chr_parse_common(opts, qapi_ChardevMux_base(backend->u.mux));
3605
    backend->u.mux->chardev = g_strdup(chardev);
3606 3607
}

3608 3609 3610 3611 3612 3613 3614
static void qemu_chr_parse_socket(QemuOpts *opts, ChardevBackend *backend,
                                  Error **errp)
{
    bool is_listen      = qemu_opt_get_bool(opts, "server", false);
    bool is_waitconnect = is_listen && qemu_opt_get_bool(opts, "wait", true);
    bool is_telnet      = qemu_opt_get_bool(opts, "telnet", false);
    bool do_nodelay     = !qemu_opt_get_bool(opts, "delay", true);
3615
    int64_t reconnect   = qemu_opt_get_number(opts, "reconnect", 0);
3616 3617 3618
    const char *path = qemu_opt_get(opts, "path");
    const char *host = qemu_opt_get(opts, "host");
    const char *port = qemu_opt_get(opts, "port");
3619
    const char *tls_creds = qemu_opt_get(opts, "tls-creds");
3620 3621 3622 3623 3624 3625 3626 3627 3628 3629 3630
    SocketAddress *addr;

    if (!path) {
        if (!host) {
            error_setg(errp, "chardev: socket: no host given");
            return;
        }
        if (!port) {
            error_setg(errp, "chardev: socket: no port given");
            return;
        }
3631 3632 3633 3634 3635
    } else {
        if (tls_creds) {
            error_setg(errp, "TLS can only be used over TCP socket");
            return;
        }
3636 3637
    }

3638
    backend->u.socket = g_new0(ChardevSocket, 1);
3639
    qemu_chr_parse_common(opts, qapi_ChardevSocket_base(backend->u.socket));
3640

3641 3642 3643 3644 3645 3646 3647 3648 3649 3650
    backend->u.socket->has_nodelay = true;
    backend->u.socket->nodelay = do_nodelay;
    backend->u.socket->has_server = true;
    backend->u.socket->server = is_listen;
    backend->u.socket->has_telnet = true;
    backend->u.socket->telnet = is_telnet;
    backend->u.socket->has_wait = true;
    backend->u.socket->wait = is_waitconnect;
    backend->u.socket->has_reconnect = true;
    backend->u.socket->reconnect = reconnect;
3651
    backend->u.socket->tls_creds = g_strdup(tls_creds);
3652 3653 3654

    addr = g_new0(SocketAddress, 1);
    if (path) {
3655 3656 3657
        addr->type = SOCKET_ADDRESS_KIND_UNIX;
        addr->u.q_unix = g_new0(UnixSocketAddress, 1);
        addr->u.q_unix->path = g_strdup(path);
3658
    } else {
3659 3660 3661 3662 3663 3664 3665 3666 3667 3668
        addr->type = SOCKET_ADDRESS_KIND_INET;
        addr->u.inet = g_new0(InetSocketAddress, 1);
        addr->u.inet->host = g_strdup(host);
        addr->u.inet->port = g_strdup(port);
        addr->u.inet->has_to = qemu_opt_get(opts, "to");
        addr->u.inet->to = qemu_opt_get_number(opts, "to", 0);
        addr->u.inet->has_ipv4 = qemu_opt_get(opts, "ipv4");
        addr->u.inet->ipv4 = qemu_opt_get_bool(opts, "ipv4", 0);
        addr->u.inet->has_ipv6 = qemu_opt_get(opts, "ipv6");
        addr->u.inet->ipv6 = qemu_opt_get_bool(opts, "ipv6", 0);
3669
    }
3670
    backend->u.socket->addr = addr;
3671 3672
}

3673 3674 3675 3676 3677 3678 3679 3680 3681 3682 3683 3684 3685 3686 3687 3688 3689 3690 3691 3692 3693 3694 3695 3696 3697 3698 3699 3700
static void qemu_chr_parse_udp(QemuOpts *opts, ChardevBackend *backend,
                               Error **errp)
{
    const char *host = qemu_opt_get(opts, "host");
    const char *port = qemu_opt_get(opts, "port");
    const char *localaddr = qemu_opt_get(opts, "localaddr");
    const char *localport = qemu_opt_get(opts, "localport");
    bool has_local = false;
    SocketAddress *addr;

    if (host == NULL || strlen(host) == 0) {
        host = "localhost";
    }
    if (port == NULL || strlen(port) == 0) {
        error_setg(errp, "chardev: udp: remote port not specified");
        return;
    }
    if (localport == NULL || strlen(localport) == 0) {
        localport = "0";
    } else {
        has_local = true;
    }
    if (localaddr == NULL || strlen(localaddr) == 0) {
        localaddr = "";
    } else {
        has_local = true;
    }

3701
    backend->u.udp = g_new0(ChardevUdp, 1);
3702
    qemu_chr_parse_common(opts, qapi_ChardevUdp_base(backend->u.udp));
3703 3704

    addr = g_new0(SocketAddress, 1);
3705 3706 3707 3708 3709 3710 3711 3712 3713
    addr->type = SOCKET_ADDRESS_KIND_INET;
    addr->u.inet = g_new0(InetSocketAddress, 1);
    addr->u.inet->host = g_strdup(host);
    addr->u.inet->port = g_strdup(port);
    addr->u.inet->has_ipv4 = qemu_opt_get(opts, "ipv4");
    addr->u.inet->ipv4 = qemu_opt_get_bool(opts, "ipv4", 0);
    addr->u.inet->has_ipv6 = qemu_opt_get(opts, "ipv6");
    addr->u.inet->ipv6 = qemu_opt_get_bool(opts, "ipv6", 0);
    backend->u.udp->remote = addr;
3714 3715

    if (has_local) {
3716
        backend->u.udp->has_local = true;
3717
        addr = g_new0(SocketAddress, 1);
3718 3719 3720 3721 3722
        addr->type = SOCKET_ADDRESS_KIND_INET;
        addr->u.inet = g_new0(InetSocketAddress, 1);
        addr->u.inet->host = g_strdup(localaddr);
        addr->u.inet->port = g_strdup(localport);
        backend->u.udp->local = addr;
3723 3724 3725
    }
}

3726
typedef struct CharDriver {
3727
    const char *name;
3728
    ChardevBackendKind kind;
3729
    void (*parse)(QemuOpts *opts, ChardevBackend *backend, Error **errp);
3730 3731
    CharDriverState *(*create)(const char *id, ChardevBackend *backend,
                               ChardevReturn *ret, Error **errp);
3732 3733 3734 3735
} CharDriver;

static GSList *backends;

3736
void register_char_driver(const char *name, ChardevBackendKind kind,
3737 3738 3739
        void (*parse)(QemuOpts *opts, ChardevBackend *backend, Error **errp),
        CharDriverState *(*create)(const char *id, ChardevBackend *backend,
                                   ChardevReturn *ret, Error **errp))
3740 3741 3742 3743 3744 3745 3746
{
    CharDriver *s;

    s = g_malloc0(sizeof(*s));
    s->name = g_strdup(name);
    s->kind = kind;
    s->parse = parse;
3747
    s->create = create;
3748 3749 3750 3751

    backends = g_slist_append(backends, s);
}

3752
CharDriverState *qemu_chr_new_from_opts(QemuOpts *opts,
3753 3754
                                    void (*init)(struct CharDriverState *s),
                                    Error **errp)
3755
{
3756
    Error *local_err = NULL;
3757
    CharDriver *cd;
3758
    CharDriverState *chr;
3759
    GSList *i;
3760 3761 3762 3763
    ChardevReturn *ret = NULL;
    ChardevBackend *backend;
    const char *id = qemu_opts_id(opts);
    char *bid = NULL;
3764

3765
    if (id == NULL) {
3766
        error_setg(errp, "chardev: no id specified");
G
Gerd Hoffmann 已提交
3767
        goto err;
3768 3769
    }

3770
    if (qemu_opt_get(opts, "backend") == NULL) {
3771
        error_setg(errp, "chardev: \"%s\" missing backend",
3772
                   qemu_opts_id(opts));
G
Gerd Hoffmann 已提交
3773
        goto err;
3774
    }
3775 3776 3777 3778
    for (i = backends; i; i = i->next) {
        cd = i->data;

        if (strcmp(cd->name, qemu_opt_get(opts, "backend")) == 0) {
3779
            break;
3780
        }
3781
    }
3782
    if (i == NULL) {
3783
        error_setg(errp, "chardev: backend \"%s\" not found",
3784
                   qemu_opt_get(opts, "backend"));
3785
        goto err;
3786 3787
    }

3788
    backend = g_new0(ChardevBackend, 1);
3789

3790 3791 3792
    if (qemu_opt_get_bool(opts, "mux", 0)) {
        bid = g_strdup_printf("%s-base", id);
    }
3793

3794
    chr = NULL;
3795
    backend->type = cd->kind;
3796 3797 3798 3799
    if (cd->parse) {
        cd->parse(opts, backend, &local_err);
        if (local_err) {
            error_propagate(errp, local_err);
3800 3801
            goto qapi_out;
        }
3802 3803 3804 3805
    } else {
        ChardevCommon *cc = g_new0(ChardevCommon, 1);
        qemu_chr_parse_common(opts, cc);
        backend->u.data = cc;
3806
    }
3807

3808 3809 3810
    ret = qmp_chardev_add(bid ? bid : id, backend, errp);
    if (!ret) {
        goto qapi_out;
3811 3812
    }

3813 3814 3815 3816
    if (bid) {
        qapi_free_ChardevBackend(backend);
        qapi_free_ChardevReturn(ret);
        backend = g_new0(ChardevBackend, 1);
3817 3818 3819
        backend->u.mux = g_new0(ChardevMux, 1);
        backend->type = CHARDEV_BACKEND_KIND_MUX;
        backend->u.mux->chardev = g_strdup(bid);
3820 3821 3822 3823 3824 3825 3826
        ret = qmp_chardev_add(id, backend, errp);
        if (!ret) {
            chr = qemu_chr_find(bid);
            qemu_chr_delete(chr);
            chr = NULL;
            goto qapi_out;
        }
3827
    }
G
Gerd Hoffmann 已提交
3828

3829
    chr = qemu_chr_find(id);
G
Gerd Hoffmann 已提交
3830
    chr->opts = opts;
3831 3832 3833 3834 3835

qapi_out:
    qapi_free_ChardevBackend(backend);
    qapi_free_ChardevReturn(ret);
    g_free(bid);
3836
    return chr;
G
Gerd Hoffmann 已提交
3837 3838 3839 3840

err:
    qemu_opts_del(opts);
    return NULL;
3841 3842
}

3843
CharDriverState *qemu_chr_new(const char *label, const char *filename, void (*init)(struct CharDriverState *s))
A
aliguori 已提交
3844 3845 3846
{
    const char *p;
    CharDriverState *chr;
3847
    QemuOpts *opts;
3848
    Error *err = NULL;
3849

G
Gerd Hoffmann 已提交
3850 3851 3852 3853
    if (strstart(filename, "chardev:", &p)) {
        return qemu_chr_find(p);
    }

3854
    opts = qemu_chr_parse_compat(label, filename);
G
Gerd Hoffmann 已提交
3855 3856
    if (!opts)
        return NULL;
A
aliguori 已提交
3857

3858
    chr = qemu_chr_new_from_opts(opts, init, &err);
3859
    if (err) {
3860
        error_report_err(err);
3861
    }
G
Gerd Hoffmann 已提交
3862
    if (chr && qemu_opt_get_bool(opts, "mux", 0)) {
3863
        qemu_chr_fe_claim_no_fail(chr);
G
Gerd Hoffmann 已提交
3864
        monitor_init(chr, MONITOR_USE_READLINE);
A
aliguori 已提交
3865 3866 3867 3868
    }
    return chr;
}

3869
void qemu_chr_fe_set_echo(struct CharDriverState *chr, bool echo)
P
Paolo Bonzini 已提交
3870 3871 3872 3873 3874 3875
{
    if (chr->chr_set_echo) {
        chr->chr_set_echo(chr, echo);
    }
}

3876
void qemu_chr_fe_set_open(struct CharDriverState *chr, int fe_open)
3877
{
3878
    if (chr->fe_open == fe_open) {
H
Hans de Goede 已提交
3879 3880
        return;
    }
3881
    chr->fe_open = fe_open;
3882 3883
    if (chr->chr_set_fe_open) {
        chr->chr_set_fe_open(chr, fe_open);
3884 3885 3886
    }
}

M
Marc-André Lureau 已提交
3887 3888 3889 3890 3891 3892 3893
void qemu_chr_fe_event(struct CharDriverState *chr, int event)
{
    if (chr->chr_fe_event) {
        chr->chr_fe_event(chr, event);
    }
}

3894 3895
int qemu_chr_fe_add_watch(CharDriverState *s, GIOCondition cond,
                          GIOFunc func, void *user_data)
A
Anthony Liguori 已提交
3896 3897 3898 3899 3900 3901 3902 3903 3904
{
    GSource *src;
    guint tag;

    if (s->chr_add_watch == NULL) {
        return -ENOSYS;
    }

    src = s->chr_add_watch(s, cond);
3905 3906 3907 3908
    if (!src) {
        return -EINVAL;
    }

A
Anthony Liguori 已提交
3909 3910 3911 3912 3913 3914 3915
    g_source_set_callback(src, (GSourceFunc)func, user_data, NULL);
    tag = g_source_attach(src, NULL);
    g_source_unref(src);

    return tag;
}

3916 3917 3918 3919 3920 3921 3922 3923 3924 3925 3926 3927 3928 3929 3930 3931 3932 3933 3934 3935 3936 3937 3938
int qemu_chr_fe_claim(CharDriverState *s)
{
    if (s->avail_connections < 1) {
        return -1;
    }
    s->avail_connections--;
    return 0;
}

void qemu_chr_fe_claim_no_fail(CharDriverState *s)
{
    if (qemu_chr_fe_claim(s) != 0) {
        fprintf(stderr, "%s: error chardev \"%s\" already used\n",
                __func__, s->label);
        exit(1);
    }
}

void qemu_chr_fe_release(CharDriverState *s)
{
    s->avail_connections++;
}

3939
static void qemu_chr_free_common(CharDriverState *chr)
A
aliguori 已提交
3940
{
3941 3942
    g_free(chr->filename);
    g_free(chr->label);
3943
    qemu_opts_del(chr->opts);
3944 3945 3946
    if (chr->logfd != -1) {
        close(chr->logfd);
    }
3947
    qemu_mutex_destroy(&chr->chr_write_lock);
3948
    g_free(chr);
A
aliguori 已提交
3949 3950
}

3951 3952 3953 3954 3955 3956 3957 3958
void qemu_chr_free(CharDriverState *chr)
{
    if (chr->chr_close) {
        chr->chr_close(chr);
    }
    qemu_chr_free_common(chr);
}

M
Marc-André Lureau 已提交
3959 3960 3961 3962 3963 3964
void qemu_chr_delete(CharDriverState *chr)
{
    QTAILQ_REMOVE(&chardevs, chr, next);
    qemu_chr_free(chr);
}

L
Luiz Capitulino 已提交
3965
ChardevInfoList *qmp_query_chardev(Error **errp)
A
aliguori 已提交
3966
{
L
Luiz Capitulino 已提交
3967
    ChardevInfoList *chr_list = NULL;
A
aliguori 已提交
3968 3969
    CharDriverState *chr;

B
Blue Swirl 已提交
3970
    QTAILQ_FOREACH(chr, &chardevs, next) {
L
Luiz Capitulino 已提交
3971 3972 3973 3974
        ChardevInfoList *info = g_malloc0(sizeof(*info));
        info->value = g_malloc0(sizeof(*info->value));
        info->value->label = g_strdup(chr->label);
        info->value->filename = g_strdup(chr->filename);
3975
        info->value->frontend_open = chr->fe_open;
L
Luiz Capitulino 已提交
3976 3977 3978

        info->next = chr_list;
        chr_list = info;
A
aliguori 已提交
3979
    }
3980

L
Luiz Capitulino 已提交
3981
    return chr_list;
A
aliguori 已提交
3982
}
G
Gerd Hoffmann 已提交
3983

3984 3985 3986 3987 3988 3989 3990 3991 3992 3993 3994 3995 3996 3997 3998 3999 4000 4001 4002
ChardevBackendInfoList *qmp_query_chardev_backends(Error **errp)
{
    ChardevBackendInfoList *backend_list = NULL;
    CharDriver *c = NULL;
    GSList *i = NULL;

    for (i = backends; i; i = i->next) {
        ChardevBackendInfoList *info = g_malloc0(sizeof(*info));
        c = i->data;
        info->value = g_malloc0(sizeof(*info->value));
        info->value->name = g_strdup(c->name);

        info->next = backend_list;
        backend_list = info;
    }

    return backend_list;
}

G
Gerd Hoffmann 已提交
4003 4004 4005 4006
CharDriverState *qemu_chr_find(const char *name)
{
    CharDriverState *chr;

B
Blue Swirl 已提交
4007
    QTAILQ_FOREACH(chr, &chardevs, next) {
G
Gerd Hoffmann 已提交
4008 4009 4010 4011 4012 4013
        if (strcmp(chr->label, name) != 0)
            continue;
        return chr;
    }
    return NULL;
}
A
Anthony Liguori 已提交
4014 4015 4016 4017 4018

/* Get a character (serial) device interface.  */
CharDriverState *qemu_char_get_next_serial(void)
{
    static int next_serial;
4019
    CharDriverState *chr;
A
Anthony Liguori 已提交
4020 4021

    /* FIXME: This function needs to go away: use chardev properties!  */
4022 4023 4024 4025 4026 4027 4028

    while (next_serial < MAX_SERIAL_PORTS && serial_hds[next_serial]) {
        chr = serial_hds[next_serial++];
        qemu_chr_fe_claim_no_fail(chr);
        return chr;
    }
    return NULL;
A
Anthony Liguori 已提交
4029 4030
}

4031 4032 4033 4034 4035 4036 4037 4038 4039 4040 4041 4042 4043 4044 4045 4046 4047 4048 4049 4050 4051 4052 4053 4054 4055 4056 4057 4058 4059 4060 4061 4062 4063 4064 4065 4066 4067 4068 4069 4070 4071
QemuOptsList qemu_chardev_opts = {
    .name = "chardev",
    .implied_opt_name = "backend",
    .head = QTAILQ_HEAD_INITIALIZER(qemu_chardev_opts.head),
    .desc = {
        {
            .name = "backend",
            .type = QEMU_OPT_STRING,
        },{
            .name = "path",
            .type = QEMU_OPT_STRING,
        },{
            .name = "host",
            .type = QEMU_OPT_STRING,
        },{
            .name = "port",
            .type = QEMU_OPT_STRING,
        },{
            .name = "localaddr",
            .type = QEMU_OPT_STRING,
        },{
            .name = "localport",
            .type = QEMU_OPT_STRING,
        },{
            .name = "to",
            .type = QEMU_OPT_NUMBER,
        },{
            .name = "ipv4",
            .type = QEMU_OPT_BOOL,
        },{
            .name = "ipv6",
            .type = QEMU_OPT_BOOL,
        },{
            .name = "wait",
            .type = QEMU_OPT_BOOL,
        },{
            .name = "server",
            .type = QEMU_OPT_BOOL,
        },{
            .name = "delay",
            .type = QEMU_OPT_BOOL,
4072 4073 4074
        },{
            .name = "reconnect",
            .type = QEMU_OPT_NUMBER,
4075 4076 4077
        },{
            .name = "telnet",
            .type = QEMU_OPT_BOOL,
4078 4079 4080
        },{
            .name = "tls-creds",
            .type = QEMU_OPT_STRING,
4081 4082 4083 4084 4085 4086 4087 4088 4089 4090 4091 4092 4093 4094 4095 4096 4097 4098 4099 4100 4101 4102 4103 4104
        },{
            .name = "width",
            .type = QEMU_OPT_NUMBER,
        },{
            .name = "height",
            .type = QEMU_OPT_NUMBER,
        },{
            .name = "cols",
            .type = QEMU_OPT_NUMBER,
        },{
            .name = "rows",
            .type = QEMU_OPT_NUMBER,
        },{
            .name = "mux",
            .type = QEMU_OPT_BOOL,
        },{
            .name = "signal",
            .type = QEMU_OPT_BOOL,
        },{
            .name = "name",
            .type = QEMU_OPT_STRING,
        },{
            .name = "debug",
            .type = QEMU_OPT_NUMBER,
4105
        },{
4106
            .name = "size",
4107
            .type = QEMU_OPT_SIZE,
4108 4109 4110
        },{
            .name = "chardev",
            .type = QEMU_OPT_STRING,
4111 4112 4113
        },{
            .name = "append",
            .type = QEMU_OPT_BOOL,
4114 4115 4116 4117 4118 4119
        },{
            .name = "logfile",
            .type = QEMU_OPT_STRING,
        },{
            .name = "logappend",
            .type = QEMU_OPT_BOOL,
4120 4121 4122 4123
        },
        { /* end of list */ }
    },
};
4124

4125 4126
#ifdef _WIN32

4127 4128 4129 4130
static CharDriverState *qmp_chardev_open_file(const char *id,
                                              ChardevBackend *backend,
                                              ChardevReturn *ret,
                                              Error **errp)
4131
{
4132
    ChardevFile *file = backend->u.file;
4133
    ChardevCommon *common = qapi_ChardevFile_base(backend->u.file);
4134 4135
    HANDLE out;

4136
    if (file->has_in) {
4137 4138 4139 4140 4141 4142 4143 4144 4145 4146
        error_setg(errp, "input file not supported");
        return NULL;
    }

    out = CreateFile(file->out, GENERIC_WRITE, FILE_SHARE_READ, NULL,
                     OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL, NULL);
    if (out == INVALID_HANDLE_VALUE) {
        error_setg(errp, "open %s failed", file->out);
        return NULL;
    }
4147
    return qemu_chr_open_win_file(out, common, errp);
4148 4149
}

4150 4151 4152
static CharDriverState *qmp_chardev_open_serial(const char *id,
                                                ChardevBackend *backend,
                                                ChardevReturn *ret,
4153
                                                Error **errp)
4154
{
4155
    ChardevHostdev *serial = backend->u.serial;
4156 4157
    ChardevCommon *common = qapi_ChardevHostdev_base(backend->u.serial);
    return qemu_chr_open_win_path(serial->device, common, errp);
4158 4159
}

4160 4161 4162 4163 4164 4165 4166 4167 4168
#else /* WIN32 */

static int qmp_chardev_open_file_source(char *src, int flags,
                                        Error **errp)
{
    int fd = -1;

    TFR(fd = qemu_open(src, flags, 0666));
    if (fd == -1) {
4169
        error_setg_file_open(errp, errno, src);
4170 4171 4172 4173
    }
    return fd;
}

4174 4175 4176 4177
static CharDriverState *qmp_chardev_open_file(const char *id,
                                              ChardevBackend *backend,
                                              ChardevReturn *ret,
                                              Error **errp)
4178
{
4179
    ChardevFile *file = backend->u.file;
4180
    ChardevCommon *common = qapi_ChardevFile_base(backend->u.file);
4181
    int flags, in = -1, out;
4182

4183 4184 4185 4186 4187 4188 4189
    flags = O_WRONLY | O_CREAT | O_BINARY;
    if (file->has_append && file->append) {
        flags |= O_APPEND;
    } else {
        flags |= O_TRUNC;
    }

4190
    out = qmp_chardev_open_file_source(file->out, flags, errp);
4191
    if (out < 0) {
4192 4193 4194
        return NULL;
    }

4195
    if (file->has_in) {
4196 4197
        flags = O_RDONLY;
        in = qmp_chardev_open_file_source(file->in, flags, errp);
4198
        if (in < 0) {
4199 4200 4201 4202 4203
            qemu_close(out);
            return NULL;
        }
    }

4204
    return qemu_chr_open_fd(in, out, common, errp);
4205 4206
}

P
Paolo Bonzini 已提交
4207
#ifdef HAVE_CHARDEV_SERIAL
4208 4209 4210
static CharDriverState *qmp_chardev_open_serial(const char *id,
                                                ChardevBackend *backend,
                                                ChardevReturn *ret,
4211
                                                Error **errp)
4212
{
4213
    ChardevHostdev *serial = backend->u.serial;
4214
    ChardevCommon *common = qapi_ChardevHostdev_base(backend->u.serial);
4215 4216 4217
    int fd;

    fd = qmp_chardev_open_file_source(serial->device, O_RDWR, errp);
4218
    if (fd < 0) {
4219
        return NULL;
4220
    }
4221
    qemu_set_nonblock(fd);
4222
    return qemu_chr_open_tty_fd(fd, common, errp);
4223
}
4224
#endif
4225

P
Paolo Bonzini 已提交
4226
#ifdef HAVE_CHARDEV_PARPORT
4227 4228 4229
static CharDriverState *qmp_chardev_open_parallel(const char *id,
                                                  ChardevBackend *backend,
                                                  ChardevReturn *ret,
4230 4231
                                                  Error **errp)
{
4232
    ChardevHostdev *parallel = backend->u.parallel;
4233
    ChardevCommon *common = qapi_ChardevHostdev_base(backend->u.parallel);
4234 4235 4236
    int fd;

    fd = qmp_chardev_open_file_source(parallel->device, O_RDWR, errp);
4237
    if (fd < 0) {
4238 4239
        return NULL;
    }
4240
    return qemu_chr_open_pp_fd(fd, common, errp);
4241
}
P
Paolo Bonzini 已提交
4242
#endif
4243

4244 4245
#endif /* WIN32 */

4246 4247 4248 4249 4250 4251 4252 4253 4254
static void socket_try_connect(CharDriverState *chr)
{
    Error *err = NULL;

    if (!qemu_chr_open_socket_fd(chr, &err)) {
        check_report_connect_error(chr, err);
    }
}

4255 4256 4257 4258 4259 4260 4261 4262 4263 4264 4265
static gboolean socket_reconnect_timeout(gpointer opaque)
{
    CharDriverState *chr = opaque;
    TCPCharDriver *s = chr->opaque;

    s->reconnect_timer = 0;

    if (chr->be_open) {
        return false;
    }

4266
    socket_try_connect(chr);
4267 4268 4269 4270

    return false;
}

4271 4272 4273
static CharDriverState *qmp_chardev_open_socket(const char *id,
                                                ChardevBackend *backend,
                                                ChardevReturn *ret,
4274 4275
                                                Error **errp)
{
4276 4277
    CharDriverState *chr;
    TCPCharDriver *s;
4278
    ChardevSocket *sock = backend->u.socket;
4279 4280 4281 4282 4283
    SocketAddress *addr = sock->addr;
    bool do_nodelay     = sock->has_nodelay ? sock->nodelay : false;
    bool is_listen      = sock->has_server  ? sock->server  : true;
    bool is_telnet      = sock->has_telnet  ? sock->telnet  : false;
    bool is_waitconnect = sock->has_wait    ? sock->wait    : false;
4284
    int64_t reconnect   = sock->has_reconnect ? sock->reconnect : 0;
4285
    ChardevCommon *common = qapi_ChardevSocket_base(backend->u.socket);
4286

4287 4288 4289 4290
    chr = qemu_chr_alloc(common, errp);
    if (!chr) {
        return NULL;
    }
4291
    s = g_new0(TCPCharDriver, 1);
4292

4293
    s->is_unix = addr->type == SOCKET_ADDRESS_KIND_UNIX;
4294 4295
    s->is_listen = is_listen;
    s->is_telnet = is_telnet;
4296
    s->do_nodelay = do_nodelay;
4297 4298 4299 4300 4301 4302 4303 4304 4305 4306 4307 4308 4309 4310 4311 4312 4313 4314 4315 4316 4317 4318 4319 4320 4321 4322 4323 4324 4325 4326 4327 4328 4329
    if (sock->tls_creds) {
        Object *creds;
        creds = object_resolve_path_component(
            object_get_objects_root(), sock->tls_creds);
        if (!creds) {
            error_setg(errp, "No TLS credentials with id '%s'",
                       sock->tls_creds);
            goto error;
        }
        s->tls_creds = (QCryptoTLSCreds *)
            object_dynamic_cast(creds,
                                TYPE_QCRYPTO_TLS_CREDS);
        if (!s->tls_creds) {
            error_setg(errp, "Object with id '%s' is not TLS credentials",
                       sock->tls_creds);
            goto error;
        }
        object_ref(OBJECT(s->tls_creds));
        if (is_listen) {
            if (s->tls_creds->endpoint != QCRYPTO_TLS_CREDS_ENDPOINT_SERVER) {
                error_setg(errp, "%s",
                           "Expected TLS credentials for server endpoint");
                goto error;
            }
        } else {
            if (s->tls_creds->endpoint != QCRYPTO_TLS_CREDS_ENDPOINT_CLIENT) {
                error_setg(errp, "%s",
                           "Expected TLS credentials for client endpoint");
                goto error;
            }
        }
    }

4330
    qapi_copy_SocketAddress(&s->addr, sock->addr);
4331 4332 4333 4334 4335 4336 4337 4338 4339 4340 4341 4342 4343

    chr->opaque = s;
    chr->chr_write = tcp_chr_write;
    chr->chr_sync_read = tcp_chr_sync_read;
    chr->chr_close = tcp_chr_close;
    chr->get_msgfds = tcp_get_msgfds;
    chr->set_msgfds = tcp_set_msgfds;
    chr->chr_add_client = tcp_chr_add_client;
    chr->chr_add_watch = tcp_chr_add_watch;
    chr->chr_update_read_handler = tcp_chr_update_read_handler;
    /* be isn't opened until we get a connection */
    chr->explicit_be_open = true;

4344 4345
    chr->filename = SocketAddress_to_str("disconnected:",
                                         addr, is_listen, is_telnet);
4346 4347

    if (is_listen) {
4348 4349 4350
        if (is_telnet) {
            s->do_telnetopt = 1;
        }
4351 4352
    } else if (reconnect > 0) {
        s->reconnect_time = reconnect;
4353
    }
4354

4355 4356 4357
    if (s->reconnect_time) {
        socket_try_connect(chr);
    } else if (!qemu_chr_open_socket_fd(chr, errp)) {
4358
        goto error;
4359
    }
4360 4361 4362 4363

    if (is_listen && is_waitconnect) {
        fprintf(stderr, "QEMU waiting for connection on: %s\n",
                chr->filename);
4364 4365
        tcp_chr_accept(QIO_CHANNEL(s->listen_ioc), G_IO_IN, chr);
        qio_channel_set_blocking(QIO_CHANNEL(s->listen_ioc), false, NULL);
4366 4367 4368
    }

    return chr;
4369 4370 4371 4372 4373 4374 4375 4376

 error:
    if (s->tls_creds) {
        object_unref(OBJECT(s->tls_creds));
    }
    g_free(s);
    qemu_chr_free_common(chr);
    return NULL;
4377 4378
}

4379 4380 4381
static CharDriverState *qmp_chardev_open_udp(const char *id,
                                             ChardevBackend *backend,
                                             ChardevReturn *ret,
4382
                                             Error **errp)
G
Gerd Hoffmann 已提交
4383
{
4384
    ChardevUdp *udp = backend->u.udp;
4385
    ChardevCommon *common = qapi_ChardevUdp_base(backend->u.udp);
4386
    QIOChannelSocket *sioc = qio_channel_socket_new();
G
Gerd Hoffmann 已提交
4387

4388
    if (qio_channel_socket_dgram_sync(sioc,
4389
                                      udp->local, udp->remote,
4390 4391
                                      errp) < 0) {
        object_unref(OBJECT(sioc));
G
Gerd Hoffmann 已提交
4392 4393
        return NULL;
    }
4394
    return qemu_chr_open_udp(sioc, common, errp);
G
Gerd Hoffmann 已提交
4395 4396
}

4397 4398 4399 4400
ChardevReturn *qmp_chardev_add(const char *id, ChardevBackend *backend,
                               Error **errp)
{
    ChardevReturn *ret = g_new0(ChardevReturn, 1);
4401
    CharDriverState *chr = NULL;
P
Paolo Bonzini 已提交
4402
    Error *local_err = NULL;
4403 4404
    GSList *i;
    CharDriver *cd;
4405 4406 4407 4408 4409 4410 4411 4412

    chr = qemu_chr_find(id);
    if (chr) {
        error_setg(errp, "Chardev '%s' already exists", id);
        g_free(ret);
        return NULL;
    }

4413 4414 4415
    for (i = backends; i; i = i->next) {
        cd = i->data;

4416
        if (cd->kind == backend->type) {
4417 4418 4419 4420 4421 4422 4423 4424 4425 4426
            chr = cd->create(id, backend, ret, &local_err);
            if (local_err) {
                error_propagate(errp, local_err);
                goto out_error;
            }
            break;
        }
    }

    if (chr == NULL) {
4427 4428 4429
        assert(!i);
        error_setg(errp, "chardev backend not available");
        goto out_error;
P
Paolo Bonzini 已提交
4430 4431 4432 4433
    }

    chr->label = g_strdup(id);
    chr->avail_connections =
4434
        (backend->type == CHARDEV_BACKEND_KIND_MUX) ? MAX_MUX : 1;
P
Paolo Bonzini 已提交
4435
    if (!chr->filename) {
4436
        chr->filename = g_strdup(ChardevBackendKind_lookup[backend->type]);
4437
    }
P
Paolo Bonzini 已提交
4438 4439 4440 4441 4442 4443 4444 4445 4446
    if (!chr->explicit_be_open) {
        qemu_chr_be_event(chr, CHR_EVENT_OPENED);
    }
    QTAILQ_INSERT_TAIL(&chardevs, chr, next);
    return ret;

out_error:
    g_free(ret);
    return NULL;
4447 4448 4449 4450 4451 4452 4453
}

void qmp_chardev_remove(const char *id, Error **errp)
{
    CharDriverState *chr;

    chr = qemu_chr_find(id);
G
Gonglei 已提交
4454
    if (chr == NULL) {
4455 4456 4457 4458 4459 4460 4461 4462 4463 4464
        error_setg(errp, "Chardev '%s' not found", id);
        return;
    }
    if (chr->chr_can_read || chr->chr_read ||
        chr->chr_event || chr->handler_opaque) {
        error_setg(errp, "Chardev '%s' is busy", id);
        return;
    }
    qemu_chr_delete(chr);
}
4465 4466 4467

static void register_types(void)
{
4468
    register_char_driver("null", CHARDEV_BACKEND_KIND_NULL, NULL,
4469
                         qemu_chr_open_null);
4470
    register_char_driver("socket", CHARDEV_BACKEND_KIND_SOCKET,
4471
                         qemu_chr_parse_socket, qmp_chardev_open_socket);
4472
    register_char_driver("udp", CHARDEV_BACKEND_KIND_UDP, qemu_chr_parse_udp,
4473
                         qmp_chardev_open_udp);
4474
    register_char_driver("ringbuf", CHARDEV_BACKEND_KIND_RINGBUF,
4475
                         qemu_chr_parse_ringbuf, qemu_chr_open_ringbuf);
4476
    register_char_driver("file", CHARDEV_BACKEND_KIND_FILE,
4477
                         qemu_chr_parse_file_out, qmp_chardev_open_file);
4478
    register_char_driver("stdio", CHARDEV_BACKEND_KIND_STDIO,
4479
                         qemu_chr_parse_stdio, qemu_chr_open_stdio);
4480
#if defined HAVE_CHARDEV_SERIAL
4481
    register_char_driver("serial", CHARDEV_BACKEND_KIND_SERIAL,
4482
                         qemu_chr_parse_serial, qmp_chardev_open_serial);
4483
    register_char_driver("tty", CHARDEV_BACKEND_KIND_SERIAL,
4484 4485
                         qemu_chr_parse_serial, qmp_chardev_open_serial);
#endif
4486
#ifdef HAVE_CHARDEV_PARPORT
4487
    register_char_driver("parallel", CHARDEV_BACKEND_KIND_PARALLEL,
4488
                         qemu_chr_parse_parallel, qmp_chardev_open_parallel);
4489
    register_char_driver("parport", CHARDEV_BACKEND_KIND_PARALLEL,
4490 4491
                         qemu_chr_parse_parallel, qmp_chardev_open_parallel);
#endif
4492
#ifdef HAVE_CHARDEV_PTY
4493
    register_char_driver("pty", CHARDEV_BACKEND_KIND_PTY, NULL,
4494 4495
                         qemu_chr_open_pty);
#endif
4496
#ifdef _WIN32
4497
    register_char_driver("console", CHARDEV_BACKEND_KIND_CONSOLE, NULL,
4498 4499
                         qemu_chr_open_win_con);
#endif
4500
    register_char_driver("pipe", CHARDEV_BACKEND_KIND_PIPE,
4501
                         qemu_chr_parse_pipe, qemu_chr_open_pipe);
4502
    register_char_driver("mux", CHARDEV_BACKEND_KIND_MUX, qemu_chr_parse_mux,
4503
                         qemu_chr_open_mux);
4504
    /* Bug-compatibility: */
4505
    register_char_driver("memory", CHARDEV_BACKEND_KIND_MEMORY,
4506
                         qemu_chr_parse_ringbuf, qemu_chr_open_ringbuf);
4507 4508 4509 4510 4511
    /* this must be done after machine init, since we register FEs with muxes
     * as part of realize functions like serial_isa_realizefn when -nographic
     * is specified
     */
    qemu_add_machine_init_done_notifier(&muxes_realize_notify);
4512 4513 4514
}

type_init(register_types);