Statistics
| Branch: | Revision:

root / qemu-char.c @ eabba580

History | View | Annotate | Download (66.6 kB)

1 6f97dba0 aliguori
/*
2 6f97dba0 aliguori
 * QEMU System Emulator
3 6f97dba0 aliguori
 *
4 6f97dba0 aliguori
 * Copyright (c) 2003-2008 Fabrice Bellard
5 6f97dba0 aliguori
 *
6 6f97dba0 aliguori
 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 6f97dba0 aliguori
 * of this software and associated documentation files (the "Software"), to deal
8 6f97dba0 aliguori
 * in the Software without restriction, including without limitation the rights
9 6f97dba0 aliguori
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 6f97dba0 aliguori
 * copies of the Software, and to permit persons to whom the Software is
11 6f97dba0 aliguori
 * furnished to do so, subject to the following conditions:
12 6f97dba0 aliguori
 *
13 6f97dba0 aliguori
 * The above copyright notice and this permission notice shall be included in
14 6f97dba0 aliguori
 * all copies or substantial portions of the Software.
15 6f97dba0 aliguori
 *
16 6f97dba0 aliguori
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 6f97dba0 aliguori
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 6f97dba0 aliguori
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 6f97dba0 aliguori
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 6f97dba0 aliguori
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 6f97dba0 aliguori
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22 6f97dba0 aliguori
 * THE SOFTWARE.
23 6f97dba0 aliguori
 */
24 6f97dba0 aliguori
#include "qemu-common.h"
25 6f97dba0 aliguori
#include "net.h"
26 376253ec aliguori
#include "monitor.h"
27 6f97dba0 aliguori
#include "console.h"
28 6f97dba0 aliguori
#include "sysemu.h"
29 6f97dba0 aliguori
#include "qemu-timer.h"
30 6f97dba0 aliguori
#include "qemu-char.h"
31 cf3ebac7 aurel32
#include "hw/usb.h"
32 cf3ebac7 aurel32
#include "hw/baum.h"
33 aa71cf80 aurel32
#include "hw/msmouse.h"
34 588b3832 Luiz Capitulino
#include "qemu-objects.h"
35 6f97dba0 aliguori
36 6f97dba0 aliguori
#include <unistd.h>
37 6f97dba0 aliguori
#include <fcntl.h>
38 6f97dba0 aliguori
#include <signal.h>
39 6f97dba0 aliguori
#include <time.h>
40 6f97dba0 aliguori
#include <errno.h>
41 6f97dba0 aliguori
#include <sys/time.h>
42 6f97dba0 aliguori
#include <zlib.h>
43 6f97dba0 aliguori
44 6f97dba0 aliguori
#ifndef _WIN32
45 6f97dba0 aliguori
#include <sys/times.h>
46 6f97dba0 aliguori
#include <sys/wait.h>
47 6f97dba0 aliguori
#include <termios.h>
48 6f97dba0 aliguori
#include <sys/mman.h>
49 6f97dba0 aliguori
#include <sys/ioctl.h>
50 24646c7e blueswir1
#include <sys/resource.h>
51 6f97dba0 aliguori
#include <sys/socket.h>
52 6f97dba0 aliguori
#include <netinet/in.h>
53 24646c7e blueswir1
#include <net/if.h>
54 24646c7e blueswir1
#include <arpa/inet.h>
55 6f97dba0 aliguori
#include <dirent.h>
56 6f97dba0 aliguori
#include <netdb.h>
57 6f97dba0 aliguori
#include <sys/select.h>
58 71e72a19 Juan Quintela
#ifdef CONFIG_BSD
59 6f97dba0 aliguori
#include <sys/stat.h>
60 a167ba50 Aurelien Jarno
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
61 6f97dba0 aliguori
#include <libutil.h>
62 6972f935 blueswir1
#include <dev/ppbus/ppi.h>
63 6972f935 blueswir1
#include <dev/ppbus/ppbconf.h>
64 a167ba50 Aurelien Jarno
#if defined(__GLIBC__)
65 a167ba50 Aurelien Jarno
#include <pty.h>
66 a167ba50 Aurelien Jarno
#endif
67 c5e97233 blueswir1
#elif defined(__DragonFly__)
68 c5e97233 blueswir1
#include <libutil.h>
69 c5e97233 blueswir1
#include <dev/misc/ppi/ppi.h>
70 c5e97233 blueswir1
#include <bus/ppbus/ppbconf.h>
71 24646c7e blueswir1
#else
72 24646c7e blueswir1
#include <util.h>
73 6f97dba0 aliguori
#endif
74 bbe813a2 Aurelien Jarno
#else
75 6f97dba0 aliguori
#ifdef __linux__
76 6f97dba0 aliguori
#include <pty.h>
77 6f97dba0 aliguori
78 6f97dba0 aliguori
#include <linux/ppdev.h>
79 6f97dba0 aliguori
#include <linux/parport.h>
80 6f97dba0 aliguori
#endif
81 6f97dba0 aliguori
#ifdef __sun__
82 6f97dba0 aliguori
#include <sys/stat.h>
83 6f97dba0 aliguori
#include <sys/ethernet.h>
84 6f97dba0 aliguori
#include <sys/sockio.h>
85 6f97dba0 aliguori
#include <netinet/arp.h>
86 6f97dba0 aliguori
#include <netinet/in.h>
87 6f97dba0 aliguori
#include <netinet/in_systm.h>
88 6f97dba0 aliguori
#include <netinet/ip.h>
89 6f97dba0 aliguori
#include <netinet/ip_icmp.h> // must come after ip.h
90 6f97dba0 aliguori
#include <netinet/udp.h>
91 6f97dba0 aliguori
#include <netinet/tcp.h>
92 6f97dba0 aliguori
#include <net/if.h>
93 6f97dba0 aliguori
#include <syslog.h>
94 6f97dba0 aliguori
#include <stropts.h>
95 6f97dba0 aliguori
#endif
96 6f97dba0 aliguori
#endif
97 6f97dba0 aliguori
#endif
98 6f97dba0 aliguori
99 6f97dba0 aliguori
#include "qemu_socket.h"
100 6f97dba0 aliguori
101 9bd7854e Amit Shah
#define READ_BUF_LEN 4096
102 9bd7854e Amit Shah
103 6f97dba0 aliguori
/***********************************************************/
104 6f97dba0 aliguori
/* character device */
105 6f97dba0 aliguori
106 72cf2d4f Blue Swirl
static QTAILQ_HEAD(CharDriverStateHead, CharDriverState) chardevs =
107 72cf2d4f Blue Swirl
    QTAILQ_HEAD_INITIALIZER(chardevs);
108 2970a6c9 aliguori
109 6f97dba0 aliguori
static void qemu_chr_event(CharDriverState *s, int event)
110 6f97dba0 aliguori
{
111 73cdf3f2 Alexander Graf
    /* Keep track if the char device is open */
112 73cdf3f2 Alexander Graf
    switch (event) {
113 73cdf3f2 Alexander Graf
        case CHR_EVENT_OPENED:
114 73cdf3f2 Alexander Graf
            s->opened = 1;
115 73cdf3f2 Alexander Graf
            break;
116 73cdf3f2 Alexander Graf
        case CHR_EVENT_CLOSED:
117 73cdf3f2 Alexander Graf
            s->opened = 0;
118 73cdf3f2 Alexander Graf
            break;
119 73cdf3f2 Alexander Graf
    }
120 73cdf3f2 Alexander Graf
121 6f97dba0 aliguori
    if (!s->chr_event)
122 6f97dba0 aliguori
        return;
123 6f97dba0 aliguori
    s->chr_event(s->handler_opaque, event);
124 6f97dba0 aliguori
}
125 6f97dba0 aliguori
126 127338e6 Amit Shah
static void qemu_chr_generic_open_bh(void *opaque)
127 6f97dba0 aliguori
{
128 6f97dba0 aliguori
    CharDriverState *s = opaque;
129 f7cbc08f Anthony Liguori
    qemu_chr_event(s, CHR_EVENT_OPENED);
130 6f97dba0 aliguori
    qemu_bh_delete(s->bh);
131 6f97dba0 aliguori
    s->bh = NULL;
132 6f97dba0 aliguori
}
133 6f97dba0 aliguori
134 127338e6 Amit Shah
void qemu_chr_generic_open(CharDriverState *s)
135 6f97dba0 aliguori
{
136 69795d67 Amit Shah
    if (s->bh == NULL) {
137 127338e6 Amit Shah
        s->bh = qemu_bh_new(qemu_chr_generic_open_bh, s);
138 6f97dba0 aliguori
        qemu_bh_schedule(s->bh);
139 6f97dba0 aliguori
    }
140 6f97dba0 aliguori
}
141 6f97dba0 aliguori
142 6f97dba0 aliguori
int qemu_chr_write(CharDriverState *s, const uint8_t *buf, int len)
143 6f97dba0 aliguori
{
144 6f97dba0 aliguori
    return s->chr_write(s, buf, len);
145 6f97dba0 aliguori
}
146 6f97dba0 aliguori
147 6f97dba0 aliguori
int qemu_chr_ioctl(CharDriverState *s, int cmd, void *arg)
148 6f97dba0 aliguori
{
149 6f97dba0 aliguori
    if (!s->chr_ioctl)
150 6f97dba0 aliguori
        return -ENOTSUP;
151 6f97dba0 aliguori
    return s->chr_ioctl(s, cmd, arg);
152 6f97dba0 aliguori
}
153 6f97dba0 aliguori
154 6f97dba0 aliguori
int qemu_chr_can_read(CharDriverState *s)
155 6f97dba0 aliguori
{
156 6f97dba0 aliguori
    if (!s->chr_can_read)
157 6f97dba0 aliguori
        return 0;
158 6f97dba0 aliguori
    return s->chr_can_read(s->handler_opaque);
159 6f97dba0 aliguori
}
160 6f97dba0 aliguori
161 6f97dba0 aliguori
void qemu_chr_read(CharDriverState *s, uint8_t *buf, int len)
162 6f97dba0 aliguori
{
163 6f97dba0 aliguori
    s->chr_read(s->handler_opaque, buf, len);
164 6f97dba0 aliguori
}
165 6f97dba0 aliguori
166 7d174059 Mark McLoughlin
int qemu_chr_get_msgfd(CharDriverState *s)
167 7d174059 Mark McLoughlin
{
168 7d174059 Mark McLoughlin
    return s->get_msgfd ? s->get_msgfd(s) : -1;
169 7d174059 Mark McLoughlin
}
170 7d174059 Mark McLoughlin
171 6f97dba0 aliguori
void qemu_chr_accept_input(CharDriverState *s)
172 6f97dba0 aliguori
{
173 6f97dba0 aliguori
    if (s->chr_accept_input)
174 6f97dba0 aliguori
        s->chr_accept_input(s);
175 6f97dba0 aliguori
}
176 6f97dba0 aliguori
177 6f97dba0 aliguori
void qemu_chr_printf(CharDriverState *s, const char *fmt, ...)
178 6f97dba0 aliguori
{
179 9bd7854e Amit Shah
    char buf[READ_BUF_LEN];
180 6f97dba0 aliguori
    va_list ap;
181 6f97dba0 aliguori
    va_start(ap, fmt);
182 6f97dba0 aliguori
    vsnprintf(buf, sizeof(buf), fmt, ap);
183 6f97dba0 aliguori
    qemu_chr_write(s, (uint8_t *)buf, strlen(buf));
184 6f97dba0 aliguori
    va_end(ap);
185 6f97dba0 aliguori
}
186 6f97dba0 aliguori
187 6f97dba0 aliguori
void qemu_chr_send_event(CharDriverState *s, int event)
188 6f97dba0 aliguori
{
189 6f97dba0 aliguori
    if (s->chr_send_event)
190 6f97dba0 aliguori
        s->chr_send_event(s, event);
191 6f97dba0 aliguori
}
192 6f97dba0 aliguori
193 6f97dba0 aliguori
void qemu_chr_add_handlers(CharDriverState *s,
194 7b27a769 Juan Quintela
                           IOCanReadHandler *fd_can_read,
195 6f97dba0 aliguori
                           IOReadHandler *fd_read,
196 6f97dba0 aliguori
                           IOEventHandler *fd_event,
197 6f97dba0 aliguori
                           void *opaque)
198 6f97dba0 aliguori
{
199 6f97dba0 aliguori
    s->chr_can_read = fd_can_read;
200 6f97dba0 aliguori
    s->chr_read = fd_read;
201 6f97dba0 aliguori
    s->chr_event = fd_event;
202 6f97dba0 aliguori
    s->handler_opaque = opaque;
203 6f97dba0 aliguori
    if (s->chr_update_read_handler)
204 6f97dba0 aliguori
        s->chr_update_read_handler(s);
205 73cdf3f2 Alexander Graf
206 73cdf3f2 Alexander Graf
    /* We're connecting to an already opened device, so let's make sure we
207 73cdf3f2 Alexander Graf
       also get the open event */
208 73cdf3f2 Alexander Graf
    if (s->opened) {
209 73cdf3f2 Alexander Graf
        qemu_chr_generic_open(s);
210 73cdf3f2 Alexander Graf
    }
211 6f97dba0 aliguori
}
212 6f97dba0 aliguori
213 6f97dba0 aliguori
static int null_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
214 6f97dba0 aliguori
{
215 6f97dba0 aliguori
    return len;
216 6f97dba0 aliguori
}
217 6f97dba0 aliguori
218 191bc01b Gerd Hoffmann
static CharDriverState *qemu_chr_open_null(QemuOpts *opts)
219 6f97dba0 aliguori
{
220 6f97dba0 aliguori
    CharDriverState *chr;
221 6f97dba0 aliguori
222 6f97dba0 aliguori
    chr = qemu_mallocz(sizeof(CharDriverState));
223 6f97dba0 aliguori
    chr->chr_write = null_chr_write;
224 6f97dba0 aliguori
    return chr;
225 6f97dba0 aliguori
}
226 6f97dba0 aliguori
227 6f97dba0 aliguori
/* MUX driver for serial I/O splitting */
228 6f97dba0 aliguori
#define MAX_MUX 4
229 6f97dba0 aliguori
#define MUX_BUFFER_SIZE 32        /* Must be a power of 2.  */
230 6f97dba0 aliguori
#define MUX_BUFFER_MASK (MUX_BUFFER_SIZE - 1)
231 6f97dba0 aliguori
typedef struct {
232 7b27a769 Juan Quintela
    IOCanReadHandler *chr_can_read[MAX_MUX];
233 6f97dba0 aliguori
    IOReadHandler *chr_read[MAX_MUX];
234 6f97dba0 aliguori
    IOEventHandler *chr_event[MAX_MUX];
235 6f97dba0 aliguori
    void *ext_opaque[MAX_MUX];
236 6f97dba0 aliguori
    CharDriverState *drv;
237 799f1f23 Gerd Hoffmann
    int focus;
238 6f97dba0 aliguori
    int mux_cnt;
239 6f97dba0 aliguori
    int term_got_escape;
240 6f97dba0 aliguori
    int max_size;
241 a80bf99f aliguori
    /* Intermediate input buffer allows to catch escape sequences even if the
242 a80bf99f aliguori
       currently active device is not accepting any input - but only until it
243 a80bf99f aliguori
       is full as well. */
244 a80bf99f aliguori
    unsigned char buffer[MAX_MUX][MUX_BUFFER_SIZE];
245 a80bf99f aliguori
    int prod[MAX_MUX];
246 a80bf99f aliguori
    int cons[MAX_MUX];
247 2d22959d Jan Kiszka
    int timestamps;
248 4ab312f7 Jan Kiszka
    int linestart;
249 2d22959d Jan Kiszka
    int64_t timestamps_start;
250 6f97dba0 aliguori
} MuxDriver;
251 6f97dba0 aliguori
252 6f97dba0 aliguori
253 6f97dba0 aliguori
static int mux_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
254 6f97dba0 aliguori
{
255 6f97dba0 aliguori
    MuxDriver *d = chr->opaque;
256 6f97dba0 aliguori
    int ret;
257 2d22959d Jan Kiszka
    if (!d->timestamps) {
258 6f97dba0 aliguori
        ret = d->drv->chr_write(d->drv, buf, len);
259 6f97dba0 aliguori
    } else {
260 6f97dba0 aliguori
        int i;
261 6f97dba0 aliguori
262 6f97dba0 aliguori
        ret = 0;
263 4ab312f7 Jan Kiszka
        for (i = 0; i < len; i++) {
264 4ab312f7 Jan Kiszka
            if (d->linestart) {
265 6f97dba0 aliguori
                char buf1[64];
266 6f97dba0 aliguori
                int64_t ti;
267 6f97dba0 aliguori
                int secs;
268 6f97dba0 aliguori
269 6f97dba0 aliguori
                ti = qemu_get_clock(rt_clock);
270 2d22959d Jan Kiszka
                if (d->timestamps_start == -1)
271 2d22959d Jan Kiszka
                    d->timestamps_start = ti;
272 2d22959d Jan Kiszka
                ti -= d->timestamps_start;
273 a4bb1db8 aliguori
                secs = ti / 1000;
274 6f97dba0 aliguori
                snprintf(buf1, sizeof(buf1),
275 6f97dba0 aliguori
                         "[%02d:%02d:%02d.%03d] ",
276 6f97dba0 aliguori
                         secs / 3600,
277 6f97dba0 aliguori
                         (secs / 60) % 60,
278 6f97dba0 aliguori
                         secs % 60,
279 a4bb1db8 aliguori
                         (int)(ti % 1000));
280 6f97dba0 aliguori
                d->drv->chr_write(d->drv, (uint8_t *)buf1, strlen(buf1));
281 4ab312f7 Jan Kiszka
                d->linestart = 0;
282 4ab312f7 Jan Kiszka
            }
283 4ab312f7 Jan Kiszka
            ret += d->drv->chr_write(d->drv, buf+i, 1);
284 4ab312f7 Jan Kiszka
            if (buf[i] == '\n') {
285 4ab312f7 Jan Kiszka
                d->linestart = 1;
286 6f97dba0 aliguori
            }
287 6f97dba0 aliguori
        }
288 6f97dba0 aliguori
    }
289 6f97dba0 aliguori
    return ret;
290 6f97dba0 aliguori
}
291 6f97dba0 aliguori
292 6f97dba0 aliguori
static const char * const mux_help[] = {
293 6f97dba0 aliguori
    "% h    print this help\n\r",
294 6f97dba0 aliguori
    "% x    exit emulator\n\r",
295 6f97dba0 aliguori
    "% s    save disk data back to file (if -snapshot)\n\r",
296 6f97dba0 aliguori
    "% t    toggle console timestamps\n\r"
297 6f97dba0 aliguori
    "% b    send break (magic sysrq)\n\r",
298 6f97dba0 aliguori
    "% c    switch between console and monitor\n\r",
299 6f97dba0 aliguori
    "% %  sends %\n\r",
300 6f97dba0 aliguori
    NULL
301 6f97dba0 aliguori
};
302 6f97dba0 aliguori
303 6f97dba0 aliguori
int term_escape_char = 0x01; /* ctrl-a is used for escape */
304 6f97dba0 aliguori
static void mux_print_help(CharDriverState *chr)
305 6f97dba0 aliguori
{
306 6f97dba0 aliguori
    int i, j;
307 6f97dba0 aliguori
    char ebuf[15] = "Escape-Char";
308 6f97dba0 aliguori
    char cbuf[50] = "\n\r";
309 6f97dba0 aliguori
310 6f97dba0 aliguori
    if (term_escape_char > 0 && term_escape_char < 26) {
311 6f97dba0 aliguori
        snprintf(cbuf, sizeof(cbuf), "\n\r");
312 6f97dba0 aliguori
        snprintf(ebuf, sizeof(ebuf), "C-%c", term_escape_char - 1 + 'a');
313 6f97dba0 aliguori
    } else {
314 6f97dba0 aliguori
        snprintf(cbuf, sizeof(cbuf),
315 6f97dba0 aliguori
                 "\n\rEscape-Char set to Ascii: 0x%02x\n\r\n\r",
316 6f97dba0 aliguori
                 term_escape_char);
317 6f97dba0 aliguori
    }
318 6f97dba0 aliguori
    chr->chr_write(chr, (uint8_t *)cbuf, strlen(cbuf));
319 6f97dba0 aliguori
    for (i = 0; mux_help[i] != NULL; i++) {
320 6f97dba0 aliguori
        for (j=0; mux_help[i][j] != '\0'; j++) {
321 6f97dba0 aliguori
            if (mux_help[i][j] == '%')
322 6f97dba0 aliguori
                chr->chr_write(chr, (uint8_t *)ebuf, strlen(ebuf));
323 6f97dba0 aliguori
            else
324 6f97dba0 aliguori
                chr->chr_write(chr, (uint8_t *)&mux_help[i][j], 1);
325 6f97dba0 aliguori
        }
326 6f97dba0 aliguori
    }
327 6f97dba0 aliguori
}
328 6f97dba0 aliguori
329 2724b180 aliguori
static void mux_chr_send_event(MuxDriver *d, int mux_nr, int event)
330 2724b180 aliguori
{
331 2724b180 aliguori
    if (d->chr_event[mux_nr])
332 2724b180 aliguori
        d->chr_event[mux_nr](d->ext_opaque[mux_nr], event);
333 2724b180 aliguori
}
334 2724b180 aliguori
335 6f97dba0 aliguori
static int mux_proc_byte(CharDriverState *chr, MuxDriver *d, int ch)
336 6f97dba0 aliguori
{
337 6f97dba0 aliguori
    if (d->term_got_escape) {
338 6f97dba0 aliguori
        d->term_got_escape = 0;
339 6f97dba0 aliguori
        if (ch == term_escape_char)
340 6f97dba0 aliguori
            goto send_char;
341 6f97dba0 aliguori
        switch(ch) {
342 6f97dba0 aliguori
        case '?':
343 6f97dba0 aliguori
        case 'h':
344 6f97dba0 aliguori
            mux_print_help(chr);
345 6f97dba0 aliguori
            break;
346 6f97dba0 aliguori
        case 'x':
347 6f97dba0 aliguori
            {
348 6f97dba0 aliguori
                 const char *term =  "QEMU: Terminated\n\r";
349 6f97dba0 aliguori
                 chr->chr_write(chr,(uint8_t *)term,strlen(term));
350 6f97dba0 aliguori
                 exit(0);
351 6f97dba0 aliguori
                 break;
352 6f97dba0 aliguori
            }
353 6f97dba0 aliguori
        case 's':
354 6ab4b5ab Markus Armbruster
            bdrv_commit_all();
355 6f97dba0 aliguori
            break;
356 6f97dba0 aliguori
        case 'b':
357 6f97dba0 aliguori
            qemu_chr_event(chr, CHR_EVENT_BREAK);
358 6f97dba0 aliguori
            break;
359 6f97dba0 aliguori
        case 'c':
360 6f97dba0 aliguori
            /* Switch to the next registered device */
361 799f1f23 Gerd Hoffmann
            mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_OUT);
362 799f1f23 Gerd Hoffmann
            d->focus++;
363 799f1f23 Gerd Hoffmann
            if (d->focus >= d->mux_cnt)
364 799f1f23 Gerd Hoffmann
                d->focus = 0;
365 799f1f23 Gerd Hoffmann
            mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_IN);
366 6f97dba0 aliguori
            break;
367 2d22959d Jan Kiszka
        case 't':
368 2d22959d Jan Kiszka
            d->timestamps = !d->timestamps;
369 2d22959d Jan Kiszka
            d->timestamps_start = -1;
370 4ab312f7 Jan Kiszka
            d->linestart = 0;
371 2d22959d Jan Kiszka
            break;
372 6f97dba0 aliguori
        }
373 6f97dba0 aliguori
    } else if (ch == term_escape_char) {
374 6f97dba0 aliguori
        d->term_got_escape = 1;
375 6f97dba0 aliguori
    } else {
376 6f97dba0 aliguori
    send_char:
377 6f97dba0 aliguori
        return 1;
378 6f97dba0 aliguori
    }
379 6f97dba0 aliguori
    return 0;
380 6f97dba0 aliguori
}
381 6f97dba0 aliguori
382 6f97dba0 aliguori
static void mux_chr_accept_input(CharDriverState *chr)
383 6f97dba0 aliguori
{
384 6f97dba0 aliguori
    MuxDriver *d = chr->opaque;
385 799f1f23 Gerd Hoffmann
    int m = d->focus;
386 6f97dba0 aliguori
387 a80bf99f aliguori
    while (d->prod[m] != d->cons[m] &&
388 6f97dba0 aliguori
           d->chr_can_read[m] &&
389 6f97dba0 aliguori
           d->chr_can_read[m](d->ext_opaque[m])) {
390 6f97dba0 aliguori
        d->chr_read[m](d->ext_opaque[m],
391 a80bf99f aliguori
                       &d->buffer[m][d->cons[m]++ & MUX_BUFFER_MASK], 1);
392 6f97dba0 aliguori
    }
393 6f97dba0 aliguori
}
394 6f97dba0 aliguori
395 6f97dba0 aliguori
static int mux_chr_can_read(void *opaque)
396 6f97dba0 aliguori
{
397 6f97dba0 aliguori
    CharDriverState *chr = opaque;
398 6f97dba0 aliguori
    MuxDriver *d = chr->opaque;
399 799f1f23 Gerd Hoffmann
    int m = d->focus;
400 6f97dba0 aliguori
401 a80bf99f aliguori
    if ((d->prod[m] - d->cons[m]) < MUX_BUFFER_SIZE)
402 6f97dba0 aliguori
        return 1;
403 a80bf99f aliguori
    if (d->chr_can_read[m])
404 a80bf99f aliguori
        return d->chr_can_read[m](d->ext_opaque[m]);
405 6f97dba0 aliguori
    return 0;
406 6f97dba0 aliguori
}
407 6f97dba0 aliguori
408 6f97dba0 aliguori
static void mux_chr_read(void *opaque, const uint8_t *buf, int size)
409 6f97dba0 aliguori
{
410 6f97dba0 aliguori
    CharDriverState *chr = opaque;
411 6f97dba0 aliguori
    MuxDriver *d = chr->opaque;
412 799f1f23 Gerd Hoffmann
    int m = d->focus;
413 6f97dba0 aliguori
    int i;
414 6f97dba0 aliguori
415 6f97dba0 aliguori
    mux_chr_accept_input (opaque);
416 6f97dba0 aliguori
417 6f97dba0 aliguori
    for(i = 0; i < size; i++)
418 6f97dba0 aliguori
        if (mux_proc_byte(chr, d, buf[i])) {
419 a80bf99f aliguori
            if (d->prod[m] == d->cons[m] &&
420 6f97dba0 aliguori
                d->chr_can_read[m] &&
421 6f97dba0 aliguori
                d->chr_can_read[m](d->ext_opaque[m]))
422 6f97dba0 aliguori
                d->chr_read[m](d->ext_opaque[m], &buf[i], 1);
423 6f97dba0 aliguori
            else
424 a80bf99f aliguori
                d->buffer[m][d->prod[m]++ & MUX_BUFFER_MASK] = buf[i];
425 6f97dba0 aliguori
        }
426 6f97dba0 aliguori
}
427 6f97dba0 aliguori
428 6f97dba0 aliguori
static void mux_chr_event(void *opaque, int event)
429 6f97dba0 aliguori
{
430 6f97dba0 aliguori
    CharDriverState *chr = opaque;
431 6f97dba0 aliguori
    MuxDriver *d = chr->opaque;
432 6f97dba0 aliguori
    int i;
433 6f97dba0 aliguori
434 6f97dba0 aliguori
    /* Send the event to all registered listeners */
435 6f97dba0 aliguori
    for (i = 0; i < d->mux_cnt; i++)
436 2724b180 aliguori
        mux_chr_send_event(d, i, event);
437 6f97dba0 aliguori
}
438 6f97dba0 aliguori
439 6f97dba0 aliguori
static void mux_chr_update_read_handler(CharDriverState *chr)
440 6f97dba0 aliguori
{
441 6f97dba0 aliguori
    MuxDriver *d = chr->opaque;
442 6f97dba0 aliguori
443 6f97dba0 aliguori
    if (d->mux_cnt >= MAX_MUX) {
444 6f97dba0 aliguori
        fprintf(stderr, "Cannot add I/O handlers, MUX array is full\n");
445 6f97dba0 aliguori
        return;
446 6f97dba0 aliguori
    }
447 6f97dba0 aliguori
    d->ext_opaque[d->mux_cnt] = chr->handler_opaque;
448 6f97dba0 aliguori
    d->chr_can_read[d->mux_cnt] = chr->chr_can_read;
449 6f97dba0 aliguori
    d->chr_read[d->mux_cnt] = chr->chr_read;
450 6f97dba0 aliguori
    d->chr_event[d->mux_cnt] = chr->chr_event;
451 6f97dba0 aliguori
    /* Fix up the real driver with mux routines */
452 6f97dba0 aliguori
    if (d->mux_cnt == 0) {
453 6f97dba0 aliguori
        qemu_chr_add_handlers(d->drv, mux_chr_can_read, mux_chr_read,
454 6f97dba0 aliguori
                              mux_chr_event, chr);
455 6f97dba0 aliguori
    }
456 799f1f23 Gerd Hoffmann
    if (d->focus != -1) {
457 799f1f23 Gerd Hoffmann
        mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_OUT);
458 a7aec5da Gerd Hoffmann
    }
459 799f1f23 Gerd Hoffmann
    d->focus = d->mux_cnt;
460 6f97dba0 aliguori
    d->mux_cnt++;
461 799f1f23 Gerd Hoffmann
    mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_IN);
462 6f97dba0 aliguori
}
463 6f97dba0 aliguori
464 6f97dba0 aliguori
static CharDriverState *qemu_chr_open_mux(CharDriverState *drv)
465 6f97dba0 aliguori
{
466 6f97dba0 aliguori
    CharDriverState *chr;
467 6f97dba0 aliguori
    MuxDriver *d;
468 6f97dba0 aliguori
469 6f97dba0 aliguori
    chr = qemu_mallocz(sizeof(CharDriverState));
470 6f97dba0 aliguori
    d = qemu_mallocz(sizeof(MuxDriver));
471 6f97dba0 aliguori
472 6f97dba0 aliguori
    chr->opaque = d;
473 6f97dba0 aliguori
    d->drv = drv;
474 799f1f23 Gerd Hoffmann
    d->focus = -1;
475 6f97dba0 aliguori
    chr->chr_write = mux_chr_write;
476 6f97dba0 aliguori
    chr->chr_update_read_handler = mux_chr_update_read_handler;
477 6f97dba0 aliguori
    chr->chr_accept_input = mux_chr_accept_input;
478 73cdf3f2 Alexander Graf
479 73cdf3f2 Alexander Graf
    /* Muxes are always open on creation */
480 73cdf3f2 Alexander Graf
    qemu_chr_generic_open(chr);
481 73cdf3f2 Alexander Graf
482 6f97dba0 aliguori
    return chr;
483 6f97dba0 aliguori
}
484 6f97dba0 aliguori
485 6f97dba0 aliguori
486 6f97dba0 aliguori
#ifdef _WIN32
487 d247d25f aliguori
int send_all(int fd, const void *buf, int len1)
488 6f97dba0 aliguori
{
489 6f97dba0 aliguori
    int ret, len;
490 6f97dba0 aliguori
491 6f97dba0 aliguori
    len = len1;
492 6f97dba0 aliguori
    while (len > 0) {
493 6f97dba0 aliguori
        ret = send(fd, buf, len, 0);
494 6f97dba0 aliguori
        if (ret < 0) {
495 6f97dba0 aliguori
            errno = WSAGetLastError();
496 6f97dba0 aliguori
            if (errno != WSAEWOULDBLOCK) {
497 6f97dba0 aliguori
                return -1;
498 6f97dba0 aliguori
            }
499 6f97dba0 aliguori
        } else if (ret == 0) {
500 6f97dba0 aliguori
            break;
501 6f97dba0 aliguori
        } else {
502 6f97dba0 aliguori
            buf += ret;
503 6f97dba0 aliguori
            len -= ret;
504 6f97dba0 aliguori
        }
505 6f97dba0 aliguori
    }
506 6f97dba0 aliguori
    return len1 - len;
507 6f97dba0 aliguori
}
508 6f97dba0 aliguori
509 6f97dba0 aliguori
#else
510 6f97dba0 aliguori
511 5fc9cfed Jes Sorensen
int send_all(int fd, const void *_buf, int len1)
512 6f97dba0 aliguori
{
513 6f97dba0 aliguori
    int ret, len;
514 5fc9cfed Jes Sorensen
    const uint8_t *buf = _buf;
515 6f97dba0 aliguori
516 6f97dba0 aliguori
    len = len1;
517 6f97dba0 aliguori
    while (len > 0) {
518 6f97dba0 aliguori
        ret = write(fd, buf, len);
519 6f97dba0 aliguori
        if (ret < 0) {
520 6f97dba0 aliguori
            if (errno != EINTR && errno != EAGAIN)
521 6f97dba0 aliguori
                return -1;
522 6f97dba0 aliguori
        } else if (ret == 0) {
523 6f97dba0 aliguori
            break;
524 6f97dba0 aliguori
        } else {
525 6f97dba0 aliguori
            buf += ret;
526 6f97dba0 aliguori
            len -= ret;
527 6f97dba0 aliguori
        }
528 6f97dba0 aliguori
    }
529 6f97dba0 aliguori
    return len1 - len;
530 6f97dba0 aliguori
}
531 6f97dba0 aliguori
#endif /* !_WIN32 */
532 6f97dba0 aliguori
533 6f97dba0 aliguori
#ifndef _WIN32
534 6f97dba0 aliguori
535 6f97dba0 aliguori
typedef struct {
536 6f97dba0 aliguori
    int fd_in, fd_out;
537 6f97dba0 aliguori
    int max_size;
538 6f97dba0 aliguori
} FDCharDriver;
539 6f97dba0 aliguori
540 6f97dba0 aliguori
#define STDIO_MAX_CLIENTS 1
541 6f97dba0 aliguori
static int stdio_nb_clients = 0;
542 6f97dba0 aliguori
543 6f97dba0 aliguori
static int fd_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
544 6f97dba0 aliguori
{
545 6f97dba0 aliguori
    FDCharDriver *s = chr->opaque;
546 6f97dba0 aliguori
    return send_all(s->fd_out, buf, len);
547 6f97dba0 aliguori
}
548 6f97dba0 aliguori
549 6f97dba0 aliguori
static int fd_chr_read_poll(void *opaque)
550 6f97dba0 aliguori
{
551 6f97dba0 aliguori
    CharDriverState *chr = opaque;
552 6f97dba0 aliguori
    FDCharDriver *s = chr->opaque;
553 6f97dba0 aliguori
554 6f97dba0 aliguori
    s->max_size = qemu_chr_can_read(chr);
555 6f97dba0 aliguori
    return s->max_size;
556 6f97dba0 aliguori
}
557 6f97dba0 aliguori
558 6f97dba0 aliguori
static void fd_chr_read(void *opaque)
559 6f97dba0 aliguori
{
560 6f97dba0 aliguori
    CharDriverState *chr = opaque;
561 6f97dba0 aliguori
    FDCharDriver *s = chr->opaque;
562 6f97dba0 aliguori
    int size, len;
563 9bd7854e Amit Shah
    uint8_t buf[READ_BUF_LEN];
564 6f97dba0 aliguori
565 6f97dba0 aliguori
    len = sizeof(buf);
566 6f97dba0 aliguori
    if (len > s->max_size)
567 6f97dba0 aliguori
        len = s->max_size;
568 6f97dba0 aliguori
    if (len == 0)
569 6f97dba0 aliguori
        return;
570 6f97dba0 aliguori
    size = read(s->fd_in, buf, len);
571 6f97dba0 aliguori
    if (size == 0) {
572 6f97dba0 aliguori
        /* FD has been closed. Remove it from the active list.  */
573 6f97dba0 aliguori
        qemu_set_fd_handler2(s->fd_in, NULL, NULL, NULL, NULL);
574 793cbfb5 Amit Shah
        qemu_chr_event(chr, CHR_EVENT_CLOSED);
575 6f97dba0 aliguori
        return;
576 6f97dba0 aliguori
    }
577 6f97dba0 aliguori
    if (size > 0) {
578 6f97dba0 aliguori
        qemu_chr_read(chr, buf, size);
579 6f97dba0 aliguori
    }
580 6f97dba0 aliguori
}
581 6f97dba0 aliguori
582 6f97dba0 aliguori
static void fd_chr_update_read_handler(CharDriverState *chr)
583 6f97dba0 aliguori
{
584 6f97dba0 aliguori
    FDCharDriver *s = chr->opaque;
585 6f97dba0 aliguori
586 6f97dba0 aliguori
    if (s->fd_in >= 0) {
587 993fbfdb Anthony Liguori
        if (display_type == DT_NOGRAPHIC && s->fd_in == 0) {
588 6f97dba0 aliguori
        } else {
589 6f97dba0 aliguori
            qemu_set_fd_handler2(s->fd_in, fd_chr_read_poll,
590 6f97dba0 aliguori
                                 fd_chr_read, NULL, chr);
591 6f97dba0 aliguori
        }
592 6f97dba0 aliguori
    }
593 6f97dba0 aliguori
}
594 6f97dba0 aliguori
595 6f97dba0 aliguori
static void fd_chr_close(struct CharDriverState *chr)
596 6f97dba0 aliguori
{
597 6f97dba0 aliguori
    FDCharDriver *s = chr->opaque;
598 6f97dba0 aliguori
599 6f97dba0 aliguori
    if (s->fd_in >= 0) {
600 993fbfdb Anthony Liguori
        if (display_type == DT_NOGRAPHIC && s->fd_in == 0) {
601 6f97dba0 aliguori
        } else {
602 6f97dba0 aliguori
            qemu_set_fd_handler2(s->fd_in, NULL, NULL, NULL, NULL);
603 6f97dba0 aliguori
        }
604 6f97dba0 aliguori
    }
605 6f97dba0 aliguori
606 6f97dba0 aliguori
    qemu_free(s);
607 793cbfb5 Amit Shah
    qemu_chr_event(chr, CHR_EVENT_CLOSED);
608 6f97dba0 aliguori
}
609 6f97dba0 aliguori
610 6f97dba0 aliguori
/* open a character device to a unix fd */
611 6f97dba0 aliguori
static CharDriverState *qemu_chr_open_fd(int fd_in, int fd_out)
612 6f97dba0 aliguori
{
613 6f97dba0 aliguori
    CharDriverState *chr;
614 6f97dba0 aliguori
    FDCharDriver *s;
615 6f97dba0 aliguori
616 6f97dba0 aliguori
    chr = qemu_mallocz(sizeof(CharDriverState));
617 6f97dba0 aliguori
    s = qemu_mallocz(sizeof(FDCharDriver));
618 6f97dba0 aliguori
    s->fd_in = fd_in;
619 6f97dba0 aliguori
    s->fd_out = fd_out;
620 6f97dba0 aliguori
    chr->opaque = s;
621 6f97dba0 aliguori
    chr->chr_write = fd_chr_write;
622 6f97dba0 aliguori
    chr->chr_update_read_handler = fd_chr_update_read_handler;
623 6f97dba0 aliguori
    chr->chr_close = fd_chr_close;
624 6f97dba0 aliguori
625 127338e6 Amit Shah
    qemu_chr_generic_open(chr);
626 6f97dba0 aliguori
627 6f97dba0 aliguori
    return chr;
628 6f97dba0 aliguori
}
629 6f97dba0 aliguori
630 7d31544f Gerd Hoffmann
static CharDriverState *qemu_chr_open_file_out(QemuOpts *opts)
631 6f97dba0 aliguori
{
632 6f97dba0 aliguori
    int fd_out;
633 6f97dba0 aliguori
634 40ff6d7e Kevin Wolf
    TFR(fd_out = qemu_open(qemu_opt_get(opts, "path"),
635 7d31544f Gerd Hoffmann
                      O_WRONLY | O_TRUNC | O_CREAT | O_BINARY, 0666));
636 6f97dba0 aliguori
    if (fd_out < 0)
637 6f97dba0 aliguori
        return NULL;
638 6f97dba0 aliguori
    return qemu_chr_open_fd(-1, fd_out);
639 6f97dba0 aliguori
}
640 6f97dba0 aliguori
641 7d31544f Gerd Hoffmann
static CharDriverState *qemu_chr_open_pipe(QemuOpts *opts)
642 6f97dba0 aliguori
{
643 6f97dba0 aliguori
    int fd_in, fd_out;
644 6f97dba0 aliguori
    char filename_in[256], filename_out[256];
645 7d31544f Gerd Hoffmann
    const char *filename = qemu_opt_get(opts, "path");
646 7d31544f Gerd Hoffmann
647 7d31544f Gerd Hoffmann
    if (filename == NULL) {
648 7d31544f Gerd Hoffmann
        fprintf(stderr, "chardev: pipe: no filename given\n");
649 7d31544f Gerd Hoffmann
        return NULL;
650 7d31544f Gerd Hoffmann
    }
651 6f97dba0 aliguori
652 6f97dba0 aliguori
    snprintf(filename_in, 256, "%s.in", filename);
653 6f97dba0 aliguori
    snprintf(filename_out, 256, "%s.out", filename);
654 40ff6d7e Kevin Wolf
    TFR(fd_in = qemu_open(filename_in, O_RDWR | O_BINARY));
655 40ff6d7e Kevin Wolf
    TFR(fd_out = qemu_open(filename_out, O_RDWR | O_BINARY));
656 6f97dba0 aliguori
    if (fd_in < 0 || fd_out < 0) {
657 6f97dba0 aliguori
        if (fd_in >= 0)
658 6f97dba0 aliguori
            close(fd_in);
659 6f97dba0 aliguori
        if (fd_out >= 0)
660 6f97dba0 aliguori
            close(fd_out);
661 6f97dba0 aliguori
        TFR(fd_in = fd_out = open(filename, O_RDWR | O_BINARY));
662 6f97dba0 aliguori
        if (fd_in < 0)
663 6f97dba0 aliguori
            return NULL;
664 6f97dba0 aliguori
    }
665 6f97dba0 aliguori
    return qemu_chr_open_fd(fd_in, fd_out);
666 6f97dba0 aliguori
}
667 6f97dba0 aliguori
668 6f97dba0 aliguori
669 6f97dba0 aliguori
/* for STDIO, we handle the case where several clients use it
670 6f97dba0 aliguori
   (nographic mode) */
671 6f97dba0 aliguori
672 6f97dba0 aliguori
#define TERM_FIFO_MAX_SIZE 1
673 6f97dba0 aliguori
674 6f97dba0 aliguori
static uint8_t term_fifo[TERM_FIFO_MAX_SIZE];
675 6f97dba0 aliguori
static int term_fifo_size;
676 6f97dba0 aliguori
677 6f97dba0 aliguori
static int stdio_read_poll(void *opaque)
678 6f97dba0 aliguori
{
679 6f97dba0 aliguori
    CharDriverState *chr = opaque;
680 6f97dba0 aliguori
681 6f97dba0 aliguori
    /* try to flush the queue if needed */
682 6f97dba0 aliguori
    if (term_fifo_size != 0 && qemu_chr_can_read(chr) > 0) {
683 6f97dba0 aliguori
        qemu_chr_read(chr, term_fifo, 1);
684 6f97dba0 aliguori
        term_fifo_size = 0;
685 6f97dba0 aliguori
    }
686 6f97dba0 aliguori
    /* see if we can absorb more chars */
687 6f97dba0 aliguori
    if (term_fifo_size == 0)
688 6f97dba0 aliguori
        return 1;
689 6f97dba0 aliguori
    else
690 6f97dba0 aliguori
        return 0;
691 6f97dba0 aliguori
}
692 6f97dba0 aliguori
693 6f97dba0 aliguori
static void stdio_read(void *opaque)
694 6f97dba0 aliguori
{
695 6f97dba0 aliguori
    int size;
696 6f97dba0 aliguori
    uint8_t buf[1];
697 6f97dba0 aliguori
    CharDriverState *chr = opaque;
698 6f97dba0 aliguori
699 6f97dba0 aliguori
    size = read(0, buf, 1);
700 6f97dba0 aliguori
    if (size == 0) {
701 6f97dba0 aliguori
        /* stdin has been closed. Remove it from the active list.  */
702 6f97dba0 aliguori
        qemu_set_fd_handler2(0, NULL, NULL, NULL, NULL);
703 793cbfb5 Amit Shah
        qemu_chr_event(chr, CHR_EVENT_CLOSED);
704 6f97dba0 aliguori
        return;
705 6f97dba0 aliguori
    }
706 6f97dba0 aliguori
    if (size > 0) {
707 6f97dba0 aliguori
        if (qemu_chr_can_read(chr) > 0) {
708 6f97dba0 aliguori
            qemu_chr_read(chr, buf, 1);
709 6f97dba0 aliguori
        } else if (term_fifo_size == 0) {
710 6f97dba0 aliguori
            term_fifo[term_fifo_size++] = buf[0];
711 6f97dba0 aliguori
        }
712 6f97dba0 aliguori
    }
713 6f97dba0 aliguori
}
714 6f97dba0 aliguori
715 6f97dba0 aliguori
/* init terminal so that we can grab keys */
716 6f97dba0 aliguori
static struct termios oldtty;
717 6f97dba0 aliguori
static int old_fd0_flags;
718 6f97dba0 aliguori
static int term_atexit_done;
719 6f97dba0 aliguori
720 6f97dba0 aliguori
static void term_exit(void)
721 6f97dba0 aliguori
{
722 6f97dba0 aliguori
    tcsetattr (0, TCSANOW, &oldtty);
723 6f97dba0 aliguori
    fcntl(0, F_SETFL, old_fd0_flags);
724 6f97dba0 aliguori
}
725 6f97dba0 aliguori
726 5989020b Kusanagi Kouichi
static void term_init(QemuOpts *opts)
727 6f97dba0 aliguori
{
728 6f97dba0 aliguori
    struct termios tty;
729 6f97dba0 aliguori
730 6f97dba0 aliguori
    tcgetattr (0, &tty);
731 6f97dba0 aliguori
    oldtty = tty;
732 6f97dba0 aliguori
    old_fd0_flags = fcntl(0, F_GETFL);
733 6f97dba0 aliguori
734 6f97dba0 aliguori
    tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
735 6f97dba0 aliguori
                          |INLCR|IGNCR|ICRNL|IXON);
736 6f97dba0 aliguori
    tty.c_oflag |= OPOST;
737 6f97dba0 aliguori
    tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN);
738 6f97dba0 aliguori
    /* if graphical mode, we allow Ctrl-C handling */
739 5989020b Kusanagi Kouichi
    if (!qemu_opt_get_bool(opts, "signal", display_type != DT_NOGRAPHIC))
740 6f97dba0 aliguori
        tty.c_lflag &= ~ISIG;
741 6f97dba0 aliguori
    tty.c_cflag &= ~(CSIZE|PARENB);
742 6f97dba0 aliguori
    tty.c_cflag |= CS8;
743 6f97dba0 aliguori
    tty.c_cc[VMIN] = 1;
744 6f97dba0 aliguori
    tty.c_cc[VTIME] = 0;
745 6f97dba0 aliguori
746 6f97dba0 aliguori
    tcsetattr (0, TCSANOW, &tty);
747 6f97dba0 aliguori
748 28695489 Anthony Liguori
    if (!term_atexit_done++)
749 28695489 Anthony Liguori
        atexit(term_exit);
750 6f97dba0 aliguori
751 6f97dba0 aliguori
    fcntl(0, F_SETFL, O_NONBLOCK);
752 6f97dba0 aliguori
}
753 6f97dba0 aliguori
754 6f97dba0 aliguori
static void qemu_chr_close_stdio(struct CharDriverState *chr)
755 6f97dba0 aliguori
{
756 6f97dba0 aliguori
    term_exit();
757 6f97dba0 aliguori
    stdio_nb_clients--;
758 6f97dba0 aliguori
    qemu_set_fd_handler2(0, NULL, NULL, NULL, NULL);
759 6f97dba0 aliguori
    fd_chr_close(chr);
760 6f97dba0 aliguori
}
761 6f97dba0 aliguori
762 3c17affb Gerd Hoffmann
static CharDriverState *qemu_chr_open_stdio(QemuOpts *opts)
763 6f97dba0 aliguori
{
764 6f97dba0 aliguori
    CharDriverState *chr;
765 6f97dba0 aliguori
766 6f97dba0 aliguori
    if (stdio_nb_clients >= STDIO_MAX_CLIENTS)
767 6f97dba0 aliguori
        return NULL;
768 6f97dba0 aliguori
    chr = qemu_chr_open_fd(0, 1);
769 6f97dba0 aliguori
    chr->chr_close = qemu_chr_close_stdio;
770 6f97dba0 aliguori
    qemu_set_fd_handler2(0, stdio_read_poll, stdio_read, NULL, chr);
771 6f97dba0 aliguori
    stdio_nb_clients++;
772 5989020b Kusanagi Kouichi
    term_init(opts);
773 6f97dba0 aliguori
774 6f97dba0 aliguori
    return chr;
775 6f97dba0 aliguori
}
776 6f97dba0 aliguori
777 6f97dba0 aliguori
#ifdef __sun__
778 6f97dba0 aliguori
/* Once Solaris has openpty(), this is going to be removed. */
779 3f4cb3d3 blueswir1
static int openpty(int *amaster, int *aslave, char *name,
780 3f4cb3d3 blueswir1
                   struct termios *termp, struct winsize *winp)
781 6f97dba0 aliguori
{
782 6f97dba0 aliguori
        const char *slave;
783 6f97dba0 aliguori
        int mfd = -1, sfd = -1;
784 6f97dba0 aliguori
785 6f97dba0 aliguori
        *amaster = *aslave = -1;
786 6f97dba0 aliguori
787 6f97dba0 aliguori
        mfd = open("/dev/ptmx", O_RDWR | O_NOCTTY);
788 6f97dba0 aliguori
        if (mfd < 0)
789 6f97dba0 aliguori
                goto err;
790 6f97dba0 aliguori
791 6f97dba0 aliguori
        if (grantpt(mfd) == -1 || unlockpt(mfd) == -1)
792 6f97dba0 aliguori
                goto err;
793 6f97dba0 aliguori
794 6f97dba0 aliguori
        if ((slave = ptsname(mfd)) == NULL)
795 6f97dba0 aliguori
                goto err;
796 6f97dba0 aliguori
797 6f97dba0 aliguori
        if ((sfd = open(slave, O_RDONLY | O_NOCTTY)) == -1)
798 6f97dba0 aliguori
                goto err;
799 6f97dba0 aliguori
800 6f97dba0 aliguori
        if (ioctl(sfd, I_PUSH, "ptem") == -1 ||
801 6f97dba0 aliguori
            (termp != NULL && tcgetattr(sfd, termp) < 0))
802 6f97dba0 aliguori
                goto err;
803 6f97dba0 aliguori
804 6f97dba0 aliguori
        if (amaster)
805 6f97dba0 aliguori
                *amaster = mfd;
806 6f97dba0 aliguori
        if (aslave)
807 6f97dba0 aliguori
                *aslave = sfd;
808 6f97dba0 aliguori
        if (winp)
809 6f97dba0 aliguori
                ioctl(sfd, TIOCSWINSZ, winp);
810 6f97dba0 aliguori
811 6f97dba0 aliguori
        return 0;
812 6f97dba0 aliguori
813 6f97dba0 aliguori
err:
814 6f97dba0 aliguori
        if (sfd != -1)
815 6f97dba0 aliguori
                close(sfd);
816 6f97dba0 aliguori
        close(mfd);
817 6f97dba0 aliguori
        return -1;
818 6f97dba0 aliguori
}
819 6f97dba0 aliguori
820 3f4cb3d3 blueswir1
static void cfmakeraw (struct termios *termios_p)
821 6f97dba0 aliguori
{
822 6f97dba0 aliguori
        termios_p->c_iflag &=
823 6f97dba0 aliguori
                ~(IGNBRK|BRKINT|PARMRK|ISTRIP|INLCR|IGNCR|ICRNL|IXON);
824 6f97dba0 aliguori
        termios_p->c_oflag &= ~OPOST;
825 6f97dba0 aliguori
        termios_p->c_lflag &= ~(ECHO|ECHONL|ICANON|ISIG|IEXTEN);
826 6f97dba0 aliguori
        termios_p->c_cflag &= ~(CSIZE|PARENB);
827 6f97dba0 aliguori
        termios_p->c_cflag |= CS8;
828 6f97dba0 aliguori
829 6f97dba0 aliguori
        termios_p->c_cc[VMIN] = 0;
830 6f97dba0 aliguori
        termios_p->c_cc[VTIME] = 0;
831 6f97dba0 aliguori
}
832 6f97dba0 aliguori
#endif
833 6f97dba0 aliguori
834 6f97dba0 aliguori
#if defined(__linux__) || defined(__sun__) || defined(__FreeBSD__) \
835 a167ba50 Aurelien Jarno
    || defined(__NetBSD__) || defined(__OpenBSD__) || defined(__DragonFly__) \
836 a167ba50 Aurelien Jarno
    || defined(__GLIBC__)
837 6f97dba0 aliguori
838 6f97dba0 aliguori
typedef struct {
839 6f97dba0 aliguori
    int fd;
840 6f97dba0 aliguori
    int connected;
841 6f97dba0 aliguori
    int polling;
842 6f97dba0 aliguori
    int read_bytes;
843 6f97dba0 aliguori
    QEMUTimer *timer;
844 6f97dba0 aliguori
} PtyCharDriver;
845 6f97dba0 aliguori
846 6f97dba0 aliguori
static void pty_chr_update_read_handler(CharDriverState *chr);
847 6f97dba0 aliguori
static void pty_chr_state(CharDriverState *chr, int connected);
848 6f97dba0 aliguori
849 6f97dba0 aliguori
static int pty_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
850 6f97dba0 aliguori
{
851 6f97dba0 aliguori
    PtyCharDriver *s = chr->opaque;
852 6f97dba0 aliguori
853 6f97dba0 aliguori
    if (!s->connected) {
854 6f97dba0 aliguori
        /* guest sends data, check for (re-)connect */
855 6f97dba0 aliguori
        pty_chr_update_read_handler(chr);
856 6f97dba0 aliguori
        return 0;
857 6f97dba0 aliguori
    }
858 6f97dba0 aliguori
    return send_all(s->fd, buf, len);
859 6f97dba0 aliguori
}
860 6f97dba0 aliguori
861 6f97dba0 aliguori
static int pty_chr_read_poll(void *opaque)
862 6f97dba0 aliguori
{
863 6f97dba0 aliguori
    CharDriverState *chr = opaque;
864 6f97dba0 aliguori
    PtyCharDriver *s = chr->opaque;
865 6f97dba0 aliguori
866 6f97dba0 aliguori
    s->read_bytes = qemu_chr_can_read(chr);
867 6f97dba0 aliguori
    return s->read_bytes;
868 6f97dba0 aliguori
}
869 6f97dba0 aliguori
870 6f97dba0 aliguori
static void pty_chr_read(void *opaque)
871 6f97dba0 aliguori
{
872 6f97dba0 aliguori
    CharDriverState *chr = opaque;
873 6f97dba0 aliguori
    PtyCharDriver *s = chr->opaque;
874 6f97dba0 aliguori
    int size, len;
875 9bd7854e Amit Shah
    uint8_t buf[READ_BUF_LEN];
876 6f97dba0 aliguori
877 6f97dba0 aliguori
    len = sizeof(buf);
878 6f97dba0 aliguori
    if (len > s->read_bytes)
879 6f97dba0 aliguori
        len = s->read_bytes;
880 6f97dba0 aliguori
    if (len == 0)
881 6f97dba0 aliguori
        return;
882 6f97dba0 aliguori
    size = read(s->fd, buf, len);
883 6f97dba0 aliguori
    if ((size == -1 && errno == EIO) ||
884 6f97dba0 aliguori
        (size == 0)) {
885 6f97dba0 aliguori
        pty_chr_state(chr, 0);
886 6f97dba0 aliguori
        return;
887 6f97dba0 aliguori
    }
888 6f97dba0 aliguori
    if (size > 0) {
889 6f97dba0 aliguori
        pty_chr_state(chr, 1);
890 6f97dba0 aliguori
        qemu_chr_read(chr, buf, size);
891 6f97dba0 aliguori
    }
892 6f97dba0 aliguori
}
893 6f97dba0 aliguori
894 6f97dba0 aliguori
static void pty_chr_update_read_handler(CharDriverState *chr)
895 6f97dba0 aliguori
{
896 6f97dba0 aliguori
    PtyCharDriver *s = chr->opaque;
897 6f97dba0 aliguori
898 6f97dba0 aliguori
    qemu_set_fd_handler2(s->fd, pty_chr_read_poll,
899 6f97dba0 aliguori
                         pty_chr_read, NULL, chr);
900 6f97dba0 aliguori
    s->polling = 1;
901 6f97dba0 aliguori
    /*
902 6f97dba0 aliguori
     * Short timeout here: just need wait long enougth that qemu makes
903 6f97dba0 aliguori
     * it through the poll loop once.  When reconnected we want a
904 6f97dba0 aliguori
     * short timeout so we notice it almost instantly.  Otherwise
905 6f97dba0 aliguori
     * read() gives us -EIO instantly, making pty_chr_state() reset the
906 6f97dba0 aliguori
     * timeout to the normal (much longer) poll interval before the
907 6f97dba0 aliguori
     * timer triggers.
908 6f97dba0 aliguori
     */
909 6f97dba0 aliguori
    qemu_mod_timer(s->timer, qemu_get_clock(rt_clock) + 10);
910 6f97dba0 aliguori
}
911 6f97dba0 aliguori
912 6f97dba0 aliguori
static void pty_chr_state(CharDriverState *chr, int connected)
913 6f97dba0 aliguori
{
914 6f97dba0 aliguori
    PtyCharDriver *s = chr->opaque;
915 6f97dba0 aliguori
916 6f97dba0 aliguori
    if (!connected) {
917 6f97dba0 aliguori
        qemu_set_fd_handler2(s->fd, NULL, NULL, NULL, NULL);
918 6f97dba0 aliguori
        s->connected = 0;
919 6f97dba0 aliguori
        s->polling = 0;
920 6f97dba0 aliguori
        /* (re-)connect poll interval for idle guests: once per second.
921 6f97dba0 aliguori
         * We check more frequently in case the guests sends data to
922 6f97dba0 aliguori
         * the virtual device linked to our pty. */
923 6f97dba0 aliguori
        qemu_mod_timer(s->timer, qemu_get_clock(rt_clock) + 1000);
924 6f97dba0 aliguori
    } else {
925 6f97dba0 aliguori
        if (!s->connected)
926 127338e6 Amit Shah
            qemu_chr_generic_open(chr);
927 6f97dba0 aliguori
        s->connected = 1;
928 6f97dba0 aliguori
    }
929 6f97dba0 aliguori
}
930 6f97dba0 aliguori
931 6f97dba0 aliguori
static void pty_chr_timer(void *opaque)
932 6f97dba0 aliguori
{
933 6f97dba0 aliguori
    struct CharDriverState *chr = opaque;
934 6f97dba0 aliguori
    PtyCharDriver *s = chr->opaque;
935 6f97dba0 aliguori
936 6f97dba0 aliguori
    if (s->connected)
937 6f97dba0 aliguori
        return;
938 6f97dba0 aliguori
    if (s->polling) {
939 6f97dba0 aliguori
        /* If we arrive here without polling being cleared due
940 6f97dba0 aliguori
         * read returning -EIO, then we are (re-)connected */
941 6f97dba0 aliguori
        pty_chr_state(chr, 1);
942 6f97dba0 aliguori
        return;
943 6f97dba0 aliguori
    }
944 6f97dba0 aliguori
945 6f97dba0 aliguori
    /* Next poll ... */
946 6f97dba0 aliguori
    pty_chr_update_read_handler(chr);
947 6f97dba0 aliguori
}
948 6f97dba0 aliguori
949 6f97dba0 aliguori
static void pty_chr_close(struct CharDriverState *chr)
950 6f97dba0 aliguori
{
951 6f97dba0 aliguori
    PtyCharDriver *s = chr->opaque;
952 6f97dba0 aliguori
953 6f97dba0 aliguori
    qemu_set_fd_handler2(s->fd, NULL, NULL, NULL, NULL);
954 6f97dba0 aliguori
    close(s->fd);
955 819f56b7 aliguori
    qemu_del_timer(s->timer);
956 819f56b7 aliguori
    qemu_free_timer(s->timer);
957 6f97dba0 aliguori
    qemu_free(s);
958 793cbfb5 Amit Shah
    qemu_chr_event(chr, CHR_EVENT_CLOSED);
959 6f97dba0 aliguori
}
960 6f97dba0 aliguori
961 4490dadf Gerd Hoffmann
static CharDriverState *qemu_chr_open_pty(QemuOpts *opts)
962 6f97dba0 aliguori
{
963 6f97dba0 aliguori
    CharDriverState *chr;
964 6f97dba0 aliguori
    PtyCharDriver *s;
965 6f97dba0 aliguori
    struct termios tty;
966 6f97dba0 aliguori
    int slave_fd, len;
967 c5e97233 blueswir1
#if defined(__OpenBSD__) || defined(__DragonFly__)
968 6f97dba0 aliguori
    char pty_name[PATH_MAX];
969 6f97dba0 aliguori
#define q_ptsname(x) pty_name
970 6f97dba0 aliguori
#else
971 6f97dba0 aliguori
    char *pty_name = NULL;
972 6f97dba0 aliguori
#define q_ptsname(x) ptsname(x)
973 6f97dba0 aliguori
#endif
974 6f97dba0 aliguori
975 6f97dba0 aliguori
    chr = qemu_mallocz(sizeof(CharDriverState));
976 6f97dba0 aliguori
    s = qemu_mallocz(sizeof(PtyCharDriver));
977 6f97dba0 aliguori
978 6f97dba0 aliguori
    if (openpty(&s->fd, &slave_fd, pty_name, NULL, NULL) < 0) {
979 6f97dba0 aliguori
        return NULL;
980 6f97dba0 aliguori
    }
981 6f97dba0 aliguori
982 6f97dba0 aliguori
    /* Set raw attributes on the pty. */
983 c3b972c3 aliguori
    tcgetattr(slave_fd, &tty);
984 6f97dba0 aliguori
    cfmakeraw(&tty);
985 6f97dba0 aliguori
    tcsetattr(slave_fd, TCSAFLUSH, &tty);
986 6f97dba0 aliguori
    close(slave_fd);
987 6f97dba0 aliguori
988 6f97dba0 aliguori
    len = strlen(q_ptsname(s->fd)) + 5;
989 6f97dba0 aliguori
    chr->filename = qemu_malloc(len);
990 6f97dba0 aliguori
    snprintf(chr->filename, len, "pty:%s", q_ptsname(s->fd));
991 4490dadf Gerd Hoffmann
    qemu_opt_set(opts, "path", q_ptsname(s->fd));
992 6f97dba0 aliguori
    fprintf(stderr, "char device redirected to %s\n", q_ptsname(s->fd));
993 6f97dba0 aliguori
994 6f97dba0 aliguori
    chr->opaque = s;
995 6f97dba0 aliguori
    chr->chr_write = pty_chr_write;
996 6f97dba0 aliguori
    chr->chr_update_read_handler = pty_chr_update_read_handler;
997 6f97dba0 aliguori
    chr->chr_close = pty_chr_close;
998 6f97dba0 aliguori
999 6f97dba0 aliguori
    s->timer = qemu_new_timer(rt_clock, pty_chr_timer, chr);
1000 6f97dba0 aliguori
1001 6f97dba0 aliguori
    return chr;
1002 6f97dba0 aliguori
}
1003 6f97dba0 aliguori
1004 6f97dba0 aliguori
static void tty_serial_init(int fd, int speed,
1005 6f97dba0 aliguori
                            int parity, int data_bits, int stop_bits)
1006 6f97dba0 aliguori
{
1007 6f97dba0 aliguori
    struct termios tty;
1008 6f97dba0 aliguori
    speed_t spd;
1009 6f97dba0 aliguori
1010 6f97dba0 aliguori
#if 0
1011 6f97dba0 aliguori
    printf("tty_serial_init: speed=%d parity=%c data=%d stop=%d\n",
1012 6f97dba0 aliguori
           speed, parity, data_bits, stop_bits);
1013 6f97dba0 aliguori
#endif
1014 6f97dba0 aliguori
    tcgetattr (fd, &tty);
1015 d3f822d2 Shahar Havivi
    if (!term_atexit_done) {
1016 d3f822d2 Shahar Havivi
        oldtty = tty;
1017 d3f822d2 Shahar Havivi
    }
1018 6f97dba0 aliguori
1019 45eea13b Stefan Weil
#define check_speed(val) if (speed <= val) { spd = B##val; break; }
1020 45eea13b Stefan Weil
    speed = speed * 10 / 11;
1021 45eea13b Stefan Weil
    do {
1022 45eea13b Stefan Weil
        check_speed(50);
1023 45eea13b Stefan Weil
        check_speed(75);
1024 45eea13b Stefan Weil
        check_speed(110);
1025 45eea13b Stefan Weil
        check_speed(134);
1026 45eea13b Stefan Weil
        check_speed(150);
1027 45eea13b Stefan Weil
        check_speed(200);
1028 45eea13b Stefan Weil
        check_speed(300);
1029 45eea13b Stefan Weil
        check_speed(600);
1030 45eea13b Stefan Weil
        check_speed(1200);
1031 45eea13b Stefan Weil
        check_speed(1800);
1032 45eea13b Stefan Weil
        check_speed(2400);
1033 45eea13b Stefan Weil
        check_speed(4800);
1034 45eea13b Stefan Weil
        check_speed(9600);
1035 45eea13b Stefan Weil
        check_speed(19200);
1036 45eea13b Stefan Weil
        check_speed(38400);
1037 45eea13b Stefan Weil
        /* Non-Posix values follow. They may be unsupported on some systems. */
1038 45eea13b Stefan Weil
        check_speed(57600);
1039 45eea13b Stefan Weil
        check_speed(115200);
1040 45eea13b Stefan Weil
#ifdef B230400
1041 45eea13b Stefan Weil
        check_speed(230400);
1042 45eea13b Stefan Weil
#endif
1043 45eea13b Stefan Weil
#ifdef B460800
1044 45eea13b Stefan Weil
        check_speed(460800);
1045 45eea13b Stefan Weil
#endif
1046 45eea13b Stefan Weil
#ifdef B500000
1047 45eea13b Stefan Weil
        check_speed(500000);
1048 45eea13b Stefan Weil
#endif
1049 45eea13b Stefan Weil
#ifdef B576000
1050 45eea13b Stefan Weil
        check_speed(576000);
1051 45eea13b Stefan Weil
#endif
1052 45eea13b Stefan Weil
#ifdef B921600
1053 45eea13b Stefan Weil
        check_speed(921600);
1054 45eea13b Stefan Weil
#endif
1055 45eea13b Stefan Weil
#ifdef B1000000
1056 45eea13b Stefan Weil
        check_speed(1000000);
1057 45eea13b Stefan Weil
#endif
1058 45eea13b Stefan Weil
#ifdef B1152000
1059 45eea13b Stefan Weil
        check_speed(1152000);
1060 45eea13b Stefan Weil
#endif
1061 45eea13b Stefan Weil
#ifdef B1500000
1062 45eea13b Stefan Weil
        check_speed(1500000);
1063 45eea13b Stefan Weil
#endif
1064 45eea13b Stefan Weil
#ifdef B2000000
1065 45eea13b Stefan Weil
        check_speed(2000000);
1066 45eea13b Stefan Weil
#endif
1067 45eea13b Stefan Weil
#ifdef B2500000
1068 45eea13b Stefan Weil
        check_speed(2500000);
1069 45eea13b Stefan Weil
#endif
1070 45eea13b Stefan Weil
#ifdef B3000000
1071 45eea13b Stefan Weil
        check_speed(3000000);
1072 45eea13b Stefan Weil
#endif
1073 45eea13b Stefan Weil
#ifdef B3500000
1074 45eea13b Stefan Weil
        check_speed(3500000);
1075 45eea13b Stefan Weil
#endif
1076 45eea13b Stefan Weil
#ifdef B4000000
1077 45eea13b Stefan Weil
        check_speed(4000000);
1078 45eea13b Stefan Weil
#endif
1079 6f97dba0 aliguori
        spd = B115200;
1080 45eea13b Stefan Weil
    } while (0);
1081 6f97dba0 aliguori
1082 6f97dba0 aliguori
    cfsetispeed(&tty, spd);
1083 6f97dba0 aliguori
    cfsetospeed(&tty, spd);
1084 6f97dba0 aliguori
1085 6f97dba0 aliguori
    tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
1086 6f97dba0 aliguori
                          |INLCR|IGNCR|ICRNL|IXON);
1087 6f97dba0 aliguori
    tty.c_oflag |= OPOST;
1088 6f97dba0 aliguori
    tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN|ISIG);
1089 6f97dba0 aliguori
    tty.c_cflag &= ~(CSIZE|PARENB|PARODD|CRTSCTS|CSTOPB);
1090 6f97dba0 aliguori
    switch(data_bits) {
1091 6f97dba0 aliguori
    default:
1092 6f97dba0 aliguori
    case 8:
1093 6f97dba0 aliguori
        tty.c_cflag |= CS8;
1094 6f97dba0 aliguori
        break;
1095 6f97dba0 aliguori
    case 7:
1096 6f97dba0 aliguori
        tty.c_cflag |= CS7;
1097 6f97dba0 aliguori
        break;
1098 6f97dba0 aliguori
    case 6:
1099 6f97dba0 aliguori
        tty.c_cflag |= CS6;
1100 6f97dba0 aliguori
        break;
1101 6f97dba0 aliguori
    case 5:
1102 6f97dba0 aliguori
        tty.c_cflag |= CS5;
1103 6f97dba0 aliguori
        break;
1104 6f97dba0 aliguori
    }
1105 6f97dba0 aliguori
    switch(parity) {
1106 6f97dba0 aliguori
    default:
1107 6f97dba0 aliguori
    case 'N':
1108 6f97dba0 aliguori
        break;
1109 6f97dba0 aliguori
    case 'E':
1110 6f97dba0 aliguori
        tty.c_cflag |= PARENB;
1111 6f97dba0 aliguori
        break;
1112 6f97dba0 aliguori
    case 'O':
1113 6f97dba0 aliguori
        tty.c_cflag |= PARENB | PARODD;
1114 6f97dba0 aliguori
        break;
1115 6f97dba0 aliguori
    }
1116 6f97dba0 aliguori
    if (stop_bits == 2)
1117 6f97dba0 aliguori
        tty.c_cflag |= CSTOPB;
1118 6f97dba0 aliguori
1119 6f97dba0 aliguori
    tcsetattr (fd, TCSANOW, &tty);
1120 6f97dba0 aliguori
}
1121 6f97dba0 aliguori
1122 6f97dba0 aliguori
static int tty_serial_ioctl(CharDriverState *chr, int cmd, void *arg)
1123 6f97dba0 aliguori
{
1124 6f97dba0 aliguori
    FDCharDriver *s = chr->opaque;
1125 6f97dba0 aliguori
1126 6f97dba0 aliguori
    switch(cmd) {
1127 6f97dba0 aliguori
    case CHR_IOCTL_SERIAL_SET_PARAMS:
1128 6f97dba0 aliguori
        {
1129 6f97dba0 aliguori
            QEMUSerialSetParams *ssp = arg;
1130 6f97dba0 aliguori
            tty_serial_init(s->fd_in, ssp->speed, ssp->parity,
1131 6f97dba0 aliguori
                            ssp->data_bits, ssp->stop_bits);
1132 6f97dba0 aliguori
        }
1133 6f97dba0 aliguori
        break;
1134 6f97dba0 aliguori
    case CHR_IOCTL_SERIAL_SET_BREAK:
1135 6f97dba0 aliguori
        {
1136 6f97dba0 aliguori
            int enable = *(int *)arg;
1137 6f97dba0 aliguori
            if (enable)
1138 6f97dba0 aliguori
                tcsendbreak(s->fd_in, 1);
1139 6f97dba0 aliguori
        }
1140 6f97dba0 aliguori
        break;
1141 6f97dba0 aliguori
    case CHR_IOCTL_SERIAL_GET_TIOCM:
1142 6f97dba0 aliguori
        {
1143 6f97dba0 aliguori
            int sarg = 0;
1144 6f97dba0 aliguori
            int *targ = (int *)arg;
1145 6f97dba0 aliguori
            ioctl(s->fd_in, TIOCMGET, &sarg);
1146 6f97dba0 aliguori
            *targ = 0;
1147 b4abdfa4 aurel32
            if (sarg & TIOCM_CTS)
1148 6f97dba0 aliguori
                *targ |= CHR_TIOCM_CTS;
1149 b4abdfa4 aurel32
            if (sarg & TIOCM_CAR)
1150 6f97dba0 aliguori
                *targ |= CHR_TIOCM_CAR;
1151 b4abdfa4 aurel32
            if (sarg & TIOCM_DSR)
1152 6f97dba0 aliguori
                *targ |= CHR_TIOCM_DSR;
1153 b4abdfa4 aurel32
            if (sarg & TIOCM_RI)
1154 6f97dba0 aliguori
                *targ |= CHR_TIOCM_RI;
1155 b4abdfa4 aurel32
            if (sarg & TIOCM_DTR)
1156 6f97dba0 aliguori
                *targ |= CHR_TIOCM_DTR;
1157 b4abdfa4 aurel32
            if (sarg & TIOCM_RTS)
1158 6f97dba0 aliguori
                *targ |= CHR_TIOCM_RTS;
1159 6f97dba0 aliguori
        }
1160 6f97dba0 aliguori
        break;
1161 6f97dba0 aliguori
    case CHR_IOCTL_SERIAL_SET_TIOCM:
1162 6f97dba0 aliguori
        {
1163 6f97dba0 aliguori
            int sarg = *(int *)arg;
1164 6f97dba0 aliguori
            int targ = 0;
1165 b4abdfa4 aurel32
            ioctl(s->fd_in, TIOCMGET, &targ);
1166 b4abdfa4 aurel32
            targ &= ~(CHR_TIOCM_CTS | CHR_TIOCM_CAR | CHR_TIOCM_DSR
1167 b4abdfa4 aurel32
                     | CHR_TIOCM_RI | CHR_TIOCM_DTR | CHR_TIOCM_RTS);
1168 b4abdfa4 aurel32
            if (sarg & CHR_TIOCM_CTS)
1169 b4abdfa4 aurel32
                targ |= TIOCM_CTS;
1170 b4abdfa4 aurel32
            if (sarg & CHR_TIOCM_CAR)
1171 b4abdfa4 aurel32
                targ |= TIOCM_CAR;
1172 b4abdfa4 aurel32
            if (sarg & CHR_TIOCM_DSR)
1173 b4abdfa4 aurel32
                targ |= TIOCM_DSR;
1174 b4abdfa4 aurel32
            if (sarg & CHR_TIOCM_RI)
1175 b4abdfa4 aurel32
                targ |= TIOCM_RI;
1176 b4abdfa4 aurel32
            if (sarg & CHR_TIOCM_DTR)
1177 6f97dba0 aliguori
                targ |= TIOCM_DTR;
1178 b4abdfa4 aurel32
            if (sarg & CHR_TIOCM_RTS)
1179 6f97dba0 aliguori
                targ |= TIOCM_RTS;
1180 6f97dba0 aliguori
            ioctl(s->fd_in, TIOCMSET, &targ);
1181 6f97dba0 aliguori
        }
1182 6f97dba0 aliguori
        break;
1183 6f97dba0 aliguori
    default:
1184 6f97dba0 aliguori
        return -ENOTSUP;
1185 6f97dba0 aliguori
    }
1186 6f97dba0 aliguori
    return 0;
1187 6f97dba0 aliguori
}
1188 6f97dba0 aliguori
1189 2d753894 Shahar Havivi
static void tty_exit(void)
1190 2d753894 Shahar Havivi
{
1191 2d753894 Shahar Havivi
    tcsetattr(0, TCSANOW, &oldtty);
1192 2d753894 Shahar Havivi
}
1193 2d753894 Shahar Havivi
1194 4266a134 David Ahern
static void qemu_chr_close_tty(CharDriverState *chr)
1195 4266a134 David Ahern
{
1196 4266a134 David Ahern
    FDCharDriver *s = chr->opaque;
1197 4266a134 David Ahern
    int fd = -1;
1198 4266a134 David Ahern
1199 4266a134 David Ahern
    if (s) {
1200 4266a134 David Ahern
        fd = s->fd_in;
1201 4266a134 David Ahern
    }
1202 4266a134 David Ahern
1203 4266a134 David Ahern
    fd_chr_close(chr);
1204 4266a134 David Ahern
1205 4266a134 David Ahern
    if (fd >= 0) {
1206 4266a134 David Ahern
        close(fd);
1207 4266a134 David Ahern
    }
1208 4266a134 David Ahern
}
1209 4266a134 David Ahern
1210 48b76496 Gerd Hoffmann
static CharDriverState *qemu_chr_open_tty(QemuOpts *opts)
1211 6f97dba0 aliguori
{
1212 48b76496 Gerd Hoffmann
    const char *filename = qemu_opt_get(opts, "path");
1213 6f97dba0 aliguori
    CharDriverState *chr;
1214 6f97dba0 aliguori
    int fd;
1215 6f97dba0 aliguori
1216 6f97dba0 aliguori
    TFR(fd = open(filename, O_RDWR | O_NONBLOCK));
1217 afc535ac Evgeniy Dushistov
    if (fd < 0) {
1218 afc535ac Evgeniy Dushistov
        return NULL;
1219 afc535ac Evgeniy Dushistov
    }
1220 6f97dba0 aliguori
    tty_serial_init(fd, 115200, 'N', 8, 1);
1221 6f97dba0 aliguori
    chr = qemu_chr_open_fd(fd, fd);
1222 6f97dba0 aliguori
    if (!chr) {
1223 6f97dba0 aliguori
        close(fd);
1224 6f97dba0 aliguori
        return NULL;
1225 6f97dba0 aliguori
    }
1226 6f97dba0 aliguori
    chr->chr_ioctl = tty_serial_ioctl;
1227 4266a134 David Ahern
    chr->chr_close = qemu_chr_close_tty;
1228 2d753894 Shahar Havivi
    if (!term_atexit_done++)
1229 2d753894 Shahar Havivi
        atexit(tty_exit);
1230 6f97dba0 aliguori
    return chr;
1231 6f97dba0 aliguori
}
1232 6f97dba0 aliguori
#else  /* ! __linux__ && ! __sun__ */
1233 cb301efe Riku Voipio
static CharDriverState *qemu_chr_open_pty(QemuOpts *opts)
1234 6f97dba0 aliguori
{
1235 6f97dba0 aliguori
    return NULL;
1236 6f97dba0 aliguori
}
1237 6f97dba0 aliguori
#endif /* __linux__ || __sun__ */
1238 6f97dba0 aliguori
1239 6f97dba0 aliguori
#if defined(__linux__)
1240 6f97dba0 aliguori
typedef struct {
1241 6f97dba0 aliguori
    int fd;
1242 6f97dba0 aliguori
    int mode;
1243 6f97dba0 aliguori
} ParallelCharDriver;
1244 6f97dba0 aliguori
1245 6f97dba0 aliguori
static int pp_hw_mode(ParallelCharDriver *s, uint16_t mode)
1246 6f97dba0 aliguori
{
1247 6f97dba0 aliguori
    if (s->mode != mode) {
1248 6f97dba0 aliguori
        int m = mode;
1249 6f97dba0 aliguori
        if (ioctl(s->fd, PPSETMODE, &m) < 0)
1250 6f97dba0 aliguori
            return 0;
1251 6f97dba0 aliguori
        s->mode = mode;
1252 6f97dba0 aliguori
    }
1253 6f97dba0 aliguori
    return 1;
1254 6f97dba0 aliguori
}
1255 6f97dba0 aliguori
1256 6f97dba0 aliguori
static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
1257 6f97dba0 aliguori
{
1258 6f97dba0 aliguori
    ParallelCharDriver *drv = chr->opaque;
1259 6f97dba0 aliguori
    int fd = drv->fd;
1260 6f97dba0 aliguori
    uint8_t b;
1261 6f97dba0 aliguori
1262 6f97dba0 aliguori
    switch(cmd) {
1263 6f97dba0 aliguori
    case CHR_IOCTL_PP_READ_DATA:
1264 6f97dba0 aliguori
        if (ioctl(fd, PPRDATA, &b) < 0)
1265 6f97dba0 aliguori
            return -ENOTSUP;
1266 6f97dba0 aliguori
        *(uint8_t *)arg = b;
1267 6f97dba0 aliguori
        break;
1268 6f97dba0 aliguori
    case CHR_IOCTL_PP_WRITE_DATA:
1269 6f97dba0 aliguori
        b = *(uint8_t *)arg;
1270 6f97dba0 aliguori
        if (ioctl(fd, PPWDATA, &b) < 0)
1271 6f97dba0 aliguori
            return -ENOTSUP;
1272 6f97dba0 aliguori
        break;
1273 6f97dba0 aliguori
    case CHR_IOCTL_PP_READ_CONTROL:
1274 6f97dba0 aliguori
        if (ioctl(fd, PPRCONTROL, &b) < 0)
1275 6f97dba0 aliguori
            return -ENOTSUP;
1276 6f97dba0 aliguori
        /* Linux gives only the lowest bits, and no way to know data
1277 6f97dba0 aliguori
           direction! For better compatibility set the fixed upper
1278 6f97dba0 aliguori
           bits. */
1279 6f97dba0 aliguori
        *(uint8_t *)arg = b | 0xc0;
1280 6f97dba0 aliguori
        break;
1281 6f97dba0 aliguori
    case CHR_IOCTL_PP_WRITE_CONTROL:
1282 6f97dba0 aliguori
        b = *(uint8_t *)arg;
1283 6f97dba0 aliguori
        if (ioctl(fd, PPWCONTROL, &b) < 0)
1284 6f97dba0 aliguori
            return -ENOTSUP;
1285 6f97dba0 aliguori
        break;
1286 6f97dba0 aliguori
    case CHR_IOCTL_PP_READ_STATUS:
1287 6f97dba0 aliguori
        if (ioctl(fd, PPRSTATUS, &b) < 0)
1288 6f97dba0 aliguori
            return -ENOTSUP;
1289 6f97dba0 aliguori
        *(uint8_t *)arg = b;
1290 6f97dba0 aliguori
        break;
1291 6f97dba0 aliguori
    case CHR_IOCTL_PP_DATA_DIR:
1292 6f97dba0 aliguori
        if (ioctl(fd, PPDATADIR, (int *)arg) < 0)
1293 6f97dba0 aliguori
            return -ENOTSUP;
1294 6f97dba0 aliguori
        break;
1295 6f97dba0 aliguori
    case CHR_IOCTL_PP_EPP_READ_ADDR:
1296 6f97dba0 aliguori
        if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
1297 6f97dba0 aliguori
            struct ParallelIOArg *parg = arg;
1298 6f97dba0 aliguori
            int n = read(fd, parg->buffer, parg->count);
1299 6f97dba0 aliguori
            if (n != parg->count) {
1300 6f97dba0 aliguori
                return -EIO;
1301 6f97dba0 aliguori
            }
1302 6f97dba0 aliguori
        }
1303 6f97dba0 aliguori
        break;
1304 6f97dba0 aliguori
    case CHR_IOCTL_PP_EPP_READ:
1305 6f97dba0 aliguori
        if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
1306 6f97dba0 aliguori
            struct ParallelIOArg *parg = arg;
1307 6f97dba0 aliguori
            int n = read(fd, parg->buffer, parg->count);
1308 6f97dba0 aliguori
            if (n != parg->count) {
1309 6f97dba0 aliguori
                return -EIO;
1310 6f97dba0 aliguori
            }
1311 6f97dba0 aliguori
        }
1312 6f97dba0 aliguori
        break;
1313 6f97dba0 aliguori
    case CHR_IOCTL_PP_EPP_WRITE_ADDR:
1314 6f97dba0 aliguori
        if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
1315 6f97dba0 aliguori
            struct ParallelIOArg *parg = arg;
1316 6f97dba0 aliguori
            int n = write(fd, parg->buffer, parg->count);
1317 6f97dba0 aliguori
            if (n != parg->count) {
1318 6f97dba0 aliguori
                return -EIO;
1319 6f97dba0 aliguori
            }
1320 6f97dba0 aliguori
        }
1321 6f97dba0 aliguori
        break;
1322 6f97dba0 aliguori
    case CHR_IOCTL_PP_EPP_WRITE:
1323 6f97dba0 aliguori
        if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
1324 6f97dba0 aliguori
            struct ParallelIOArg *parg = arg;
1325 6f97dba0 aliguori
            int n = write(fd, parg->buffer, parg->count);
1326 6f97dba0 aliguori
            if (n != parg->count) {
1327 6f97dba0 aliguori
                return -EIO;
1328 6f97dba0 aliguori
            }
1329 6f97dba0 aliguori
        }
1330 6f97dba0 aliguori
        break;
1331 6f97dba0 aliguori
    default:
1332 6f97dba0 aliguori
        return -ENOTSUP;
1333 6f97dba0 aliguori
    }
1334 6f97dba0 aliguori
    return 0;
1335 6f97dba0 aliguori
}
1336 6f97dba0 aliguori
1337 6f97dba0 aliguori
static void pp_close(CharDriverState *chr)
1338 6f97dba0 aliguori
{
1339 6f97dba0 aliguori
    ParallelCharDriver *drv = chr->opaque;
1340 6f97dba0 aliguori
    int fd = drv->fd;
1341 6f97dba0 aliguori
1342 6f97dba0 aliguori
    pp_hw_mode(drv, IEEE1284_MODE_COMPAT);
1343 6f97dba0 aliguori
    ioctl(fd, PPRELEASE);
1344 6f97dba0 aliguori
    close(fd);
1345 6f97dba0 aliguori
    qemu_free(drv);
1346 793cbfb5 Amit Shah
    qemu_chr_event(chr, CHR_EVENT_CLOSED);
1347 6f97dba0 aliguori
}
1348 6f97dba0 aliguori
1349 48b76496 Gerd Hoffmann
static CharDriverState *qemu_chr_open_pp(QemuOpts *opts)
1350 6f97dba0 aliguori
{
1351 48b76496 Gerd Hoffmann
    const char *filename = qemu_opt_get(opts, "path");
1352 6f97dba0 aliguori
    CharDriverState *chr;
1353 6f97dba0 aliguori
    ParallelCharDriver *drv;
1354 6f97dba0 aliguori
    int fd;
1355 6f97dba0 aliguori
1356 6f97dba0 aliguori
    TFR(fd = open(filename, O_RDWR));
1357 6f97dba0 aliguori
    if (fd < 0)
1358 6f97dba0 aliguori
        return NULL;
1359 6f97dba0 aliguori
1360 6f97dba0 aliguori
    if (ioctl(fd, PPCLAIM) < 0) {
1361 6f97dba0 aliguori
        close(fd);
1362 6f97dba0 aliguori
        return NULL;
1363 6f97dba0 aliguori
    }
1364 6f97dba0 aliguori
1365 6f97dba0 aliguori
    drv = qemu_mallocz(sizeof(ParallelCharDriver));
1366 6f97dba0 aliguori
    drv->fd = fd;
1367 6f97dba0 aliguori
    drv->mode = IEEE1284_MODE_COMPAT;
1368 6f97dba0 aliguori
1369 6f97dba0 aliguori
    chr = qemu_mallocz(sizeof(CharDriverState));
1370 6f97dba0 aliguori
    chr->chr_write = null_chr_write;
1371 6f97dba0 aliguori
    chr->chr_ioctl = pp_ioctl;
1372 6f97dba0 aliguori
    chr->chr_close = pp_close;
1373 6f97dba0 aliguori
    chr->opaque = drv;
1374 6f97dba0 aliguori
1375 127338e6 Amit Shah
    qemu_chr_generic_open(chr);
1376 6f97dba0 aliguori
1377 6f97dba0 aliguori
    return chr;
1378 6f97dba0 aliguori
}
1379 6f97dba0 aliguori
#endif /* __linux__ */
1380 6f97dba0 aliguori
1381 a167ba50 Aurelien Jarno
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__DragonFly__)
1382 6972f935 blueswir1
static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
1383 6972f935 blueswir1
{
1384 d1839d73 Juergen Lock
    int fd = (int)(long)chr->opaque;
1385 6972f935 blueswir1
    uint8_t b;
1386 6972f935 blueswir1
1387 6972f935 blueswir1
    switch(cmd) {
1388 6972f935 blueswir1
    case CHR_IOCTL_PP_READ_DATA:
1389 6972f935 blueswir1
        if (ioctl(fd, PPIGDATA, &b) < 0)
1390 6972f935 blueswir1
            return -ENOTSUP;
1391 6972f935 blueswir1
        *(uint8_t *)arg = b;
1392 6972f935 blueswir1
        break;
1393 6972f935 blueswir1
    case CHR_IOCTL_PP_WRITE_DATA:
1394 6972f935 blueswir1
        b = *(uint8_t *)arg;
1395 6972f935 blueswir1
        if (ioctl(fd, PPISDATA, &b) < 0)
1396 6972f935 blueswir1
            return -ENOTSUP;
1397 6972f935 blueswir1
        break;
1398 6972f935 blueswir1
    case CHR_IOCTL_PP_READ_CONTROL:
1399 6972f935 blueswir1
        if (ioctl(fd, PPIGCTRL, &b) < 0)
1400 6972f935 blueswir1
            return -ENOTSUP;
1401 6972f935 blueswir1
        *(uint8_t *)arg = b;
1402 6972f935 blueswir1
        break;
1403 6972f935 blueswir1
    case CHR_IOCTL_PP_WRITE_CONTROL:
1404 6972f935 blueswir1
        b = *(uint8_t *)arg;
1405 6972f935 blueswir1
        if (ioctl(fd, PPISCTRL, &b) < 0)
1406 6972f935 blueswir1
            return -ENOTSUP;
1407 6972f935 blueswir1
        break;
1408 6972f935 blueswir1
    case CHR_IOCTL_PP_READ_STATUS:
1409 6972f935 blueswir1
        if (ioctl(fd, PPIGSTATUS, &b) < 0)
1410 6972f935 blueswir1
            return -ENOTSUP;
1411 6972f935 blueswir1
        *(uint8_t *)arg = b;
1412 6972f935 blueswir1
        break;
1413 6972f935 blueswir1
    default:
1414 6972f935 blueswir1
        return -ENOTSUP;
1415 6972f935 blueswir1
    }
1416 6972f935 blueswir1
    return 0;
1417 6972f935 blueswir1
}
1418 6972f935 blueswir1
1419 48b76496 Gerd Hoffmann
static CharDriverState *qemu_chr_open_pp(QemuOpts *opts)
1420 6972f935 blueswir1
{
1421 48b76496 Gerd Hoffmann
    const char *filename = qemu_opt_get(opts, "path");
1422 6972f935 blueswir1
    CharDriverState *chr;
1423 6972f935 blueswir1
    int fd;
1424 6972f935 blueswir1
1425 6972f935 blueswir1
    fd = open(filename, O_RDWR);
1426 6972f935 blueswir1
    if (fd < 0)
1427 6972f935 blueswir1
        return NULL;
1428 6972f935 blueswir1
1429 6972f935 blueswir1
    chr = qemu_mallocz(sizeof(CharDriverState));
1430 d1839d73 Juergen Lock
    chr->opaque = (void *)(long)fd;
1431 6972f935 blueswir1
    chr->chr_write = null_chr_write;
1432 6972f935 blueswir1
    chr->chr_ioctl = pp_ioctl;
1433 6972f935 blueswir1
    return chr;
1434 6972f935 blueswir1
}
1435 6972f935 blueswir1
#endif
1436 6972f935 blueswir1
1437 6f97dba0 aliguori
#else /* _WIN32 */
1438 6f97dba0 aliguori
1439 6f97dba0 aliguori
typedef struct {
1440 6f97dba0 aliguori
    int max_size;
1441 6f97dba0 aliguori
    HANDLE hcom, hrecv, hsend;
1442 6f97dba0 aliguori
    OVERLAPPED orecv, osend;
1443 6f97dba0 aliguori
    BOOL fpipe;
1444 6f97dba0 aliguori
    DWORD len;
1445 6f97dba0 aliguori
} WinCharState;
1446 6f97dba0 aliguori
1447 6f97dba0 aliguori
#define NSENDBUF 2048
1448 6f97dba0 aliguori
#define NRECVBUF 2048
1449 6f97dba0 aliguori
#define MAXCONNECT 1
1450 6f97dba0 aliguori
#define NTIMEOUT 5000
1451 6f97dba0 aliguori
1452 6f97dba0 aliguori
static int win_chr_poll(void *opaque);
1453 6f97dba0 aliguori
static int win_chr_pipe_poll(void *opaque);
1454 6f97dba0 aliguori
1455 6f97dba0 aliguori
static void win_chr_close(CharDriverState *chr)
1456 6f97dba0 aliguori
{
1457 6f97dba0 aliguori
    WinCharState *s = chr->opaque;
1458 6f97dba0 aliguori
1459 6f97dba0 aliguori
    if (s->hsend) {
1460 6f97dba0 aliguori
        CloseHandle(s->hsend);
1461 6f97dba0 aliguori
        s->hsend = NULL;
1462 6f97dba0 aliguori
    }
1463 6f97dba0 aliguori
    if (s->hrecv) {
1464 6f97dba0 aliguori
        CloseHandle(s->hrecv);
1465 6f97dba0 aliguori
        s->hrecv = NULL;
1466 6f97dba0 aliguori
    }
1467 6f97dba0 aliguori
    if (s->hcom) {
1468 6f97dba0 aliguori
        CloseHandle(s->hcom);
1469 6f97dba0 aliguori
        s->hcom = NULL;
1470 6f97dba0 aliguori
    }
1471 6f97dba0 aliguori
    if (s->fpipe)
1472 6f97dba0 aliguori
        qemu_del_polling_cb(win_chr_pipe_poll, chr);
1473 6f97dba0 aliguori
    else
1474 6f97dba0 aliguori
        qemu_del_polling_cb(win_chr_poll, chr);
1475 793cbfb5 Amit Shah
1476 793cbfb5 Amit Shah
    qemu_chr_event(chr, CHR_EVENT_CLOSED);
1477 6f97dba0 aliguori
}
1478 6f97dba0 aliguori
1479 6f97dba0 aliguori
static int win_chr_init(CharDriverState *chr, const char *filename)
1480 6f97dba0 aliguori
{
1481 6f97dba0 aliguori
    WinCharState *s = chr->opaque;
1482 6f97dba0 aliguori
    COMMCONFIG comcfg;
1483 6f97dba0 aliguori
    COMMTIMEOUTS cto = { 0, 0, 0, 0, 0};
1484 6f97dba0 aliguori
    COMSTAT comstat;
1485 6f97dba0 aliguori
    DWORD size;
1486 6f97dba0 aliguori
    DWORD err;
1487 6f97dba0 aliguori
1488 6f97dba0 aliguori
    s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
1489 6f97dba0 aliguori
    if (!s->hsend) {
1490 6f97dba0 aliguori
        fprintf(stderr, "Failed CreateEvent\n");
1491 6f97dba0 aliguori
        goto fail;
1492 6f97dba0 aliguori
    }
1493 6f97dba0 aliguori
    s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
1494 6f97dba0 aliguori
    if (!s->hrecv) {
1495 6f97dba0 aliguori
        fprintf(stderr, "Failed CreateEvent\n");
1496 6f97dba0 aliguori
        goto fail;
1497 6f97dba0 aliguori
    }
1498 6f97dba0 aliguori
1499 6f97dba0 aliguori
    s->hcom = CreateFile(filename, GENERIC_READ|GENERIC_WRITE, 0, NULL,
1500 6f97dba0 aliguori
                      OPEN_EXISTING, FILE_FLAG_OVERLAPPED, 0);
1501 6f97dba0 aliguori
    if (s->hcom == INVALID_HANDLE_VALUE) {
1502 6f97dba0 aliguori
        fprintf(stderr, "Failed CreateFile (%lu)\n", GetLastError());
1503 6f97dba0 aliguori
        s->hcom = NULL;
1504 6f97dba0 aliguori
        goto fail;
1505 6f97dba0 aliguori
    }
1506 6f97dba0 aliguori
1507 6f97dba0 aliguori
    if (!SetupComm(s->hcom, NRECVBUF, NSENDBUF)) {
1508 6f97dba0 aliguori
        fprintf(stderr, "Failed SetupComm\n");
1509 6f97dba0 aliguori
        goto fail;
1510 6f97dba0 aliguori
    }
1511 6f97dba0 aliguori
1512 6f97dba0 aliguori
    ZeroMemory(&comcfg, sizeof(COMMCONFIG));
1513 6f97dba0 aliguori
    size = sizeof(COMMCONFIG);
1514 6f97dba0 aliguori
    GetDefaultCommConfig(filename, &comcfg, &size);
1515 6f97dba0 aliguori
    comcfg.dcb.DCBlength = sizeof(DCB);
1516 6f97dba0 aliguori
    CommConfigDialog(filename, NULL, &comcfg);
1517 6f97dba0 aliguori
1518 6f97dba0 aliguori
    if (!SetCommState(s->hcom, &comcfg.dcb)) {
1519 6f97dba0 aliguori
        fprintf(stderr, "Failed SetCommState\n");
1520 6f97dba0 aliguori
        goto fail;
1521 6f97dba0 aliguori
    }
1522 6f97dba0 aliguori
1523 6f97dba0 aliguori
    if (!SetCommMask(s->hcom, EV_ERR)) {
1524 6f97dba0 aliguori
        fprintf(stderr, "Failed SetCommMask\n");
1525 6f97dba0 aliguori
        goto fail;
1526 6f97dba0 aliguori
    }
1527 6f97dba0 aliguori
1528 6f97dba0 aliguori
    cto.ReadIntervalTimeout = MAXDWORD;
1529 6f97dba0 aliguori
    if (!SetCommTimeouts(s->hcom, &cto)) {
1530 6f97dba0 aliguori
        fprintf(stderr, "Failed SetCommTimeouts\n");
1531 6f97dba0 aliguori
        goto fail;
1532 6f97dba0 aliguori
    }
1533 6f97dba0 aliguori
1534 6f97dba0 aliguori
    if (!ClearCommError(s->hcom, &err, &comstat)) {
1535 6f97dba0 aliguori
        fprintf(stderr, "Failed ClearCommError\n");
1536 6f97dba0 aliguori
        goto fail;
1537 6f97dba0 aliguori
    }
1538 6f97dba0 aliguori
    qemu_add_polling_cb(win_chr_poll, chr);
1539 6f97dba0 aliguori
    return 0;
1540 6f97dba0 aliguori
1541 6f97dba0 aliguori
 fail:
1542 6f97dba0 aliguori
    win_chr_close(chr);
1543 6f97dba0 aliguori
    return -1;
1544 6f97dba0 aliguori
}
1545 6f97dba0 aliguori
1546 6f97dba0 aliguori
static int win_chr_write(CharDriverState *chr, const uint8_t *buf, int len1)
1547 6f97dba0 aliguori
{
1548 6f97dba0 aliguori
    WinCharState *s = chr->opaque;
1549 6f97dba0 aliguori
    DWORD len, ret, size, err;
1550 6f97dba0 aliguori
1551 6f97dba0 aliguori
    len = len1;
1552 6f97dba0 aliguori
    ZeroMemory(&s->osend, sizeof(s->osend));
1553 6f97dba0 aliguori
    s->osend.hEvent = s->hsend;
1554 6f97dba0 aliguori
    while (len > 0) {
1555 6f97dba0 aliguori
        if (s->hsend)
1556 6f97dba0 aliguori
            ret = WriteFile(s->hcom, buf, len, &size, &s->osend);
1557 6f97dba0 aliguori
        else
1558 6f97dba0 aliguori
            ret = WriteFile(s->hcom, buf, len, &size, NULL);
1559 6f97dba0 aliguori
        if (!ret) {
1560 6f97dba0 aliguori
            err = GetLastError();
1561 6f97dba0 aliguori
            if (err == ERROR_IO_PENDING) {
1562 6f97dba0 aliguori
                ret = GetOverlappedResult(s->hcom, &s->osend, &size, TRUE);
1563 6f97dba0 aliguori
                if (ret) {
1564 6f97dba0 aliguori
                    buf += size;
1565 6f97dba0 aliguori
                    len -= size;
1566 6f97dba0 aliguori
                } else {
1567 6f97dba0 aliguori
                    break;
1568 6f97dba0 aliguori
                }
1569 6f97dba0 aliguori
            } else {
1570 6f97dba0 aliguori
                break;
1571 6f97dba0 aliguori
            }
1572 6f97dba0 aliguori
        } else {
1573 6f97dba0 aliguori
            buf += size;
1574 6f97dba0 aliguori
            len -= size;
1575 6f97dba0 aliguori
        }
1576 6f97dba0 aliguori
    }
1577 6f97dba0 aliguori
    return len1 - len;
1578 6f97dba0 aliguori
}
1579 6f97dba0 aliguori
1580 6f97dba0 aliguori
static int win_chr_read_poll(CharDriverState *chr)
1581 6f97dba0 aliguori
{
1582 6f97dba0 aliguori
    WinCharState *s = chr->opaque;
1583 6f97dba0 aliguori
1584 6f97dba0 aliguori
    s->max_size = qemu_chr_can_read(chr);
1585 6f97dba0 aliguori
    return s->max_size;
1586 6f97dba0 aliguori
}
1587 6f97dba0 aliguori
1588 6f97dba0 aliguori
static void win_chr_readfile(CharDriverState *chr)
1589 6f97dba0 aliguori
{
1590 6f97dba0 aliguori
    WinCharState *s = chr->opaque;
1591 6f97dba0 aliguori
    int ret, err;
1592 9bd7854e Amit Shah
    uint8_t buf[READ_BUF_LEN];
1593 6f97dba0 aliguori
    DWORD size;
1594 6f97dba0 aliguori
1595 6f97dba0 aliguori
    ZeroMemory(&s->orecv, sizeof(s->orecv));
1596 6f97dba0 aliguori
    s->orecv.hEvent = s->hrecv;
1597 6f97dba0 aliguori
    ret = ReadFile(s->hcom, buf, s->len, &size, &s->orecv);
1598 6f97dba0 aliguori
    if (!ret) {
1599 6f97dba0 aliguori
        err = GetLastError();
1600 6f97dba0 aliguori
        if (err == ERROR_IO_PENDING) {
1601 6f97dba0 aliguori
            ret = GetOverlappedResult(s->hcom, &s->orecv, &size, TRUE);
1602 6f97dba0 aliguori
        }
1603 6f97dba0 aliguori
    }
1604 6f97dba0 aliguori
1605 6f97dba0 aliguori
    if (size > 0) {
1606 6f97dba0 aliguori
        qemu_chr_read(chr, buf, size);
1607 6f97dba0 aliguori
    }
1608 6f97dba0 aliguori
}
1609 6f97dba0 aliguori
1610 6f97dba0 aliguori
static void win_chr_read(CharDriverState *chr)
1611 6f97dba0 aliguori
{
1612 6f97dba0 aliguori
    WinCharState *s = chr->opaque;
1613 6f97dba0 aliguori
1614 6f97dba0 aliguori
    if (s->len > s->max_size)
1615 6f97dba0 aliguori
        s->len = s->max_size;
1616 6f97dba0 aliguori
    if (s->len == 0)
1617 6f97dba0 aliguori
        return;
1618 6f97dba0 aliguori
1619 6f97dba0 aliguori
    win_chr_readfile(chr);
1620 6f97dba0 aliguori
}
1621 6f97dba0 aliguori
1622 6f97dba0 aliguori
static int win_chr_poll(void *opaque)
1623 6f97dba0 aliguori
{
1624 6f97dba0 aliguori
    CharDriverState *chr = opaque;
1625 6f97dba0 aliguori
    WinCharState *s = chr->opaque;
1626 6f97dba0 aliguori
    COMSTAT status;
1627 6f97dba0 aliguori
    DWORD comerr;
1628 6f97dba0 aliguori
1629 6f97dba0 aliguori
    ClearCommError(s->hcom, &comerr, &status);
1630 6f97dba0 aliguori
    if (status.cbInQue > 0) {
1631 6f97dba0 aliguori
        s->len = status.cbInQue;
1632 6f97dba0 aliguori
        win_chr_read_poll(chr);
1633 6f97dba0 aliguori
        win_chr_read(chr);
1634 6f97dba0 aliguori
        return 1;
1635 6f97dba0 aliguori
    }
1636 6f97dba0 aliguori
    return 0;
1637 6f97dba0 aliguori
}
1638 6f97dba0 aliguori
1639 48b76496 Gerd Hoffmann
static CharDriverState *qemu_chr_open_win(QemuOpts *opts)
1640 6f97dba0 aliguori
{
1641 48b76496 Gerd Hoffmann
    const char *filename = qemu_opt_get(opts, "path");
1642 6f97dba0 aliguori
    CharDriverState *chr;
1643 6f97dba0 aliguori
    WinCharState *s;
1644 6f97dba0 aliguori
1645 6f97dba0 aliguori
    chr = qemu_mallocz(sizeof(CharDriverState));
1646 6f97dba0 aliguori
    s = qemu_mallocz(sizeof(WinCharState));
1647 6f97dba0 aliguori
    chr->opaque = s;
1648 6f97dba0 aliguori
    chr->chr_write = win_chr_write;
1649 6f97dba0 aliguori
    chr->chr_close = win_chr_close;
1650 6f97dba0 aliguori
1651 6f97dba0 aliguori
    if (win_chr_init(chr, filename) < 0) {
1652 6f97dba0 aliguori
        free(s);
1653 6f97dba0 aliguori
        free(chr);
1654 6f97dba0 aliguori
        return NULL;
1655 6f97dba0 aliguori
    }
1656 127338e6 Amit Shah
    qemu_chr_generic_open(chr);
1657 6f97dba0 aliguori
    return chr;
1658 6f97dba0 aliguori
}
1659 6f97dba0 aliguori
1660 6f97dba0 aliguori
static int win_chr_pipe_poll(void *opaque)
1661 6f97dba0 aliguori
{
1662 6f97dba0 aliguori
    CharDriverState *chr = opaque;
1663 6f97dba0 aliguori
    WinCharState *s = chr->opaque;
1664 6f97dba0 aliguori
    DWORD size;
1665 6f97dba0 aliguori
1666 6f97dba0 aliguori
    PeekNamedPipe(s->hcom, NULL, 0, NULL, &size, NULL);
1667 6f97dba0 aliguori
    if (size > 0) {
1668 6f97dba0 aliguori
        s->len = size;
1669 6f97dba0 aliguori
        win_chr_read_poll(chr);
1670 6f97dba0 aliguori
        win_chr_read(chr);
1671 6f97dba0 aliguori
        return 1;
1672 6f97dba0 aliguori
    }
1673 6f97dba0 aliguori
    return 0;
1674 6f97dba0 aliguori
}
1675 6f97dba0 aliguori
1676 6f97dba0 aliguori
static int win_chr_pipe_init(CharDriverState *chr, const char *filename)
1677 6f97dba0 aliguori
{
1678 6f97dba0 aliguori
    WinCharState *s = chr->opaque;
1679 6f97dba0 aliguori
    OVERLAPPED ov;
1680 6f97dba0 aliguori
    int ret;
1681 6f97dba0 aliguori
    DWORD size;
1682 6f97dba0 aliguori
    char openname[256];
1683 6f97dba0 aliguori
1684 6f97dba0 aliguori
    s->fpipe = TRUE;
1685 6f97dba0 aliguori
1686 6f97dba0 aliguori
    s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
1687 6f97dba0 aliguori
    if (!s->hsend) {
1688 6f97dba0 aliguori
        fprintf(stderr, "Failed CreateEvent\n");
1689 6f97dba0 aliguori
        goto fail;
1690 6f97dba0 aliguori
    }
1691 6f97dba0 aliguori
    s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
1692 6f97dba0 aliguori
    if (!s->hrecv) {
1693 6f97dba0 aliguori
        fprintf(stderr, "Failed CreateEvent\n");
1694 6f97dba0 aliguori
        goto fail;
1695 6f97dba0 aliguori
    }
1696 6f97dba0 aliguori
1697 6f97dba0 aliguori
    snprintf(openname, sizeof(openname), "\\\\.\\pipe\\%s", filename);
1698 6f97dba0 aliguori
    s->hcom = CreateNamedPipe(openname, PIPE_ACCESS_DUPLEX | FILE_FLAG_OVERLAPPED,
1699 6f97dba0 aliguori
                              PIPE_TYPE_BYTE | PIPE_READMODE_BYTE |
1700 6f97dba0 aliguori
                              PIPE_WAIT,
1701 6f97dba0 aliguori
                              MAXCONNECT, NSENDBUF, NRECVBUF, NTIMEOUT, NULL);
1702 6f97dba0 aliguori
    if (s->hcom == INVALID_HANDLE_VALUE) {
1703 6f97dba0 aliguori
        fprintf(stderr, "Failed CreateNamedPipe (%lu)\n", GetLastError());
1704 6f97dba0 aliguori
        s->hcom = NULL;
1705 6f97dba0 aliguori
        goto fail;
1706 6f97dba0 aliguori
    }
1707 6f97dba0 aliguori
1708 6f97dba0 aliguori
    ZeroMemory(&ov, sizeof(ov));
1709 6f97dba0 aliguori
    ov.hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
1710 6f97dba0 aliguori
    ret = ConnectNamedPipe(s->hcom, &ov);
1711 6f97dba0 aliguori
    if (ret) {
1712 6f97dba0 aliguori
        fprintf(stderr, "Failed ConnectNamedPipe\n");
1713 6f97dba0 aliguori
        goto fail;
1714 6f97dba0 aliguori
    }
1715 6f97dba0 aliguori
1716 6f97dba0 aliguori
    ret = GetOverlappedResult(s->hcom, &ov, &size, TRUE);
1717 6f97dba0 aliguori
    if (!ret) {
1718 6f97dba0 aliguori
        fprintf(stderr, "Failed GetOverlappedResult\n");
1719 6f97dba0 aliguori
        if (ov.hEvent) {
1720 6f97dba0 aliguori
            CloseHandle(ov.hEvent);
1721 6f97dba0 aliguori
            ov.hEvent = NULL;
1722 6f97dba0 aliguori
        }
1723 6f97dba0 aliguori
        goto fail;
1724 6f97dba0 aliguori
    }
1725 6f97dba0 aliguori
1726 6f97dba0 aliguori
    if (ov.hEvent) {
1727 6f97dba0 aliguori
        CloseHandle(ov.hEvent);
1728 6f97dba0 aliguori
        ov.hEvent = NULL;
1729 6f97dba0 aliguori
    }
1730 6f97dba0 aliguori
    qemu_add_polling_cb(win_chr_pipe_poll, chr);
1731 6f97dba0 aliguori
    return 0;
1732 6f97dba0 aliguori
1733 6f97dba0 aliguori
 fail:
1734 6f97dba0 aliguori
    win_chr_close(chr);
1735 6f97dba0 aliguori
    return -1;
1736 6f97dba0 aliguori
}
1737 6f97dba0 aliguori
1738 6f97dba0 aliguori
1739 7d31544f Gerd Hoffmann
static CharDriverState *qemu_chr_open_win_pipe(QemuOpts *opts)
1740 6f97dba0 aliguori
{
1741 7d31544f Gerd Hoffmann
    const char *filename = qemu_opt_get(opts, "path");
1742 6f97dba0 aliguori
    CharDriverState *chr;
1743 6f97dba0 aliguori
    WinCharState *s;
1744 6f97dba0 aliguori
1745 6f97dba0 aliguori
    chr = qemu_mallocz(sizeof(CharDriverState));
1746 6f97dba0 aliguori
    s = qemu_mallocz(sizeof(WinCharState));
1747 6f97dba0 aliguori
    chr->opaque = s;
1748 6f97dba0 aliguori
    chr->chr_write = win_chr_write;
1749 6f97dba0 aliguori
    chr->chr_close = win_chr_close;
1750 6f97dba0 aliguori
1751 6f97dba0 aliguori
    if (win_chr_pipe_init(chr, filename) < 0) {
1752 6f97dba0 aliguori
        free(s);
1753 6f97dba0 aliguori
        free(chr);
1754 6f97dba0 aliguori
        return NULL;
1755 6f97dba0 aliguori
    }
1756 127338e6 Amit Shah
    qemu_chr_generic_open(chr);
1757 6f97dba0 aliguori
    return chr;
1758 6f97dba0 aliguori
}
1759 6f97dba0 aliguori
1760 6f97dba0 aliguori
static CharDriverState *qemu_chr_open_win_file(HANDLE fd_out)
1761 6f97dba0 aliguori
{
1762 6f97dba0 aliguori
    CharDriverState *chr;
1763 6f97dba0 aliguori
    WinCharState *s;
1764 6f97dba0 aliguori
1765 6f97dba0 aliguori
    chr = qemu_mallocz(sizeof(CharDriverState));
1766 6f97dba0 aliguori
    s = qemu_mallocz(sizeof(WinCharState));
1767 6f97dba0 aliguori
    s->hcom = fd_out;
1768 6f97dba0 aliguori
    chr->opaque = s;
1769 6f97dba0 aliguori
    chr->chr_write = win_chr_write;
1770 127338e6 Amit Shah
    qemu_chr_generic_open(chr);
1771 6f97dba0 aliguori
    return chr;
1772 6f97dba0 aliguori
}
1773 6f97dba0 aliguori
1774 d6c983cd Gerd Hoffmann
static CharDriverState *qemu_chr_open_win_con(QemuOpts *opts)
1775 6f97dba0 aliguori
{
1776 6f97dba0 aliguori
    return qemu_chr_open_win_file(GetStdHandle(STD_OUTPUT_HANDLE));
1777 6f97dba0 aliguori
}
1778 6f97dba0 aliguori
1779 7d31544f Gerd Hoffmann
static CharDriverState *qemu_chr_open_win_file_out(QemuOpts *opts)
1780 6f97dba0 aliguori
{
1781 7d31544f Gerd Hoffmann
    const char *file_out = qemu_opt_get(opts, "path");
1782 6f97dba0 aliguori
    HANDLE fd_out;
1783 6f97dba0 aliguori
1784 6f97dba0 aliguori
    fd_out = CreateFile(file_out, GENERIC_WRITE, FILE_SHARE_READ, NULL,
1785 6f97dba0 aliguori
                        OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL, NULL);
1786 6f97dba0 aliguori
    if (fd_out == INVALID_HANDLE_VALUE)
1787 6f97dba0 aliguori
        return NULL;
1788 6f97dba0 aliguori
1789 6f97dba0 aliguori
    return qemu_chr_open_win_file(fd_out);
1790 6f97dba0 aliguori
}
1791 6f97dba0 aliguori
#endif /* !_WIN32 */
1792 6f97dba0 aliguori
1793 6f97dba0 aliguori
/***********************************************************/
1794 6f97dba0 aliguori
/* UDP Net console */
1795 6f97dba0 aliguori
1796 6f97dba0 aliguori
typedef struct {
1797 6f97dba0 aliguori
    int fd;
1798 9bd7854e Amit Shah
    uint8_t buf[READ_BUF_LEN];
1799 6f97dba0 aliguori
    int bufcnt;
1800 6f97dba0 aliguori
    int bufptr;
1801 6f97dba0 aliguori
    int max_size;
1802 6f97dba0 aliguori
} NetCharDriver;
1803 6f97dba0 aliguori
1804 6f97dba0 aliguori
static int udp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1805 6f97dba0 aliguori
{
1806 6f97dba0 aliguori
    NetCharDriver *s = chr->opaque;
1807 6f97dba0 aliguori
1808 7e1b35b4 Gerd Hoffmann
    return send(s->fd, (const void *)buf, len, 0);
1809 6f97dba0 aliguori
}
1810 6f97dba0 aliguori
1811 6f97dba0 aliguori
static int udp_chr_read_poll(void *opaque)
1812 6f97dba0 aliguori
{
1813 6f97dba0 aliguori
    CharDriverState *chr = opaque;
1814 6f97dba0 aliguori
    NetCharDriver *s = chr->opaque;
1815 6f97dba0 aliguori
1816 6f97dba0 aliguori
    s->max_size = qemu_chr_can_read(chr);
1817 6f97dba0 aliguori
1818 6f97dba0 aliguori
    /* If there were any stray characters in the queue process them
1819 6f97dba0 aliguori
     * first
1820 6f97dba0 aliguori
     */
1821 6f97dba0 aliguori
    while (s->max_size > 0 && s->bufptr < s->bufcnt) {
1822 6f97dba0 aliguori
        qemu_chr_read(chr, &s->buf[s->bufptr], 1);
1823 6f97dba0 aliguori
        s->bufptr++;
1824 6f97dba0 aliguori
        s->max_size = qemu_chr_can_read(chr);
1825 6f97dba0 aliguori
    }
1826 6f97dba0 aliguori
    return s->max_size;
1827 6f97dba0 aliguori
}
1828 6f97dba0 aliguori
1829 6f97dba0 aliguori
static void udp_chr_read(void *opaque)
1830 6f97dba0 aliguori
{
1831 6f97dba0 aliguori
    CharDriverState *chr = opaque;
1832 6f97dba0 aliguori
    NetCharDriver *s = chr->opaque;
1833 6f97dba0 aliguori
1834 6f97dba0 aliguori
    if (s->max_size == 0)
1835 6f97dba0 aliguori
        return;
1836 c5b76b38 Blue Swirl
    s->bufcnt = recv(s->fd, (void *)s->buf, sizeof(s->buf), 0);
1837 6f97dba0 aliguori
    s->bufptr = s->bufcnt;
1838 6f97dba0 aliguori
    if (s->bufcnt <= 0)
1839 6f97dba0 aliguori
        return;
1840 6f97dba0 aliguori
1841 6f97dba0 aliguori
    s->bufptr = 0;
1842 6f97dba0 aliguori
    while (s->max_size > 0 && s->bufptr < s->bufcnt) {
1843 6f97dba0 aliguori
        qemu_chr_read(chr, &s->buf[s->bufptr], 1);
1844 6f97dba0 aliguori
        s->bufptr++;
1845 6f97dba0 aliguori
        s->max_size = qemu_chr_can_read(chr);
1846 6f97dba0 aliguori
    }
1847 6f97dba0 aliguori
}
1848 6f97dba0 aliguori
1849 6f97dba0 aliguori
static void udp_chr_update_read_handler(CharDriverState *chr)
1850 6f97dba0 aliguori
{
1851 6f97dba0 aliguori
    NetCharDriver *s = chr->opaque;
1852 6f97dba0 aliguori
1853 6f97dba0 aliguori
    if (s->fd >= 0) {
1854 6f97dba0 aliguori
        qemu_set_fd_handler2(s->fd, udp_chr_read_poll,
1855 6f97dba0 aliguori
                             udp_chr_read, NULL, chr);
1856 6f97dba0 aliguori
    }
1857 6f97dba0 aliguori
}
1858 6f97dba0 aliguori
1859 819f56b7 aliguori
static void udp_chr_close(CharDriverState *chr)
1860 819f56b7 aliguori
{
1861 819f56b7 aliguori
    NetCharDriver *s = chr->opaque;
1862 819f56b7 aliguori
    if (s->fd >= 0) {
1863 819f56b7 aliguori
        qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
1864 819f56b7 aliguori
        closesocket(s->fd);
1865 819f56b7 aliguori
    }
1866 819f56b7 aliguori
    qemu_free(s);
1867 793cbfb5 Amit Shah
    qemu_chr_event(chr, CHR_EVENT_CLOSED);
1868 819f56b7 aliguori
}
1869 819f56b7 aliguori
1870 7e1b35b4 Gerd Hoffmann
static CharDriverState *qemu_chr_open_udp(QemuOpts *opts)
1871 6f97dba0 aliguori
{
1872 6f97dba0 aliguori
    CharDriverState *chr = NULL;
1873 6f97dba0 aliguori
    NetCharDriver *s = NULL;
1874 6f97dba0 aliguori
    int fd = -1;
1875 6f97dba0 aliguori
1876 6f97dba0 aliguori
    chr = qemu_mallocz(sizeof(CharDriverState));
1877 6f97dba0 aliguori
    s = qemu_mallocz(sizeof(NetCharDriver));
1878 6f97dba0 aliguori
1879 7e1b35b4 Gerd Hoffmann
    fd = inet_dgram_opts(opts);
1880 6f97dba0 aliguori
    if (fd < 0) {
1881 7e1b35b4 Gerd Hoffmann
        fprintf(stderr, "inet_dgram_opts failed\n");
1882 6f97dba0 aliguori
        goto return_err;
1883 6f97dba0 aliguori
    }
1884 6f97dba0 aliguori
1885 6f97dba0 aliguori
    s->fd = fd;
1886 6f97dba0 aliguori
    s->bufcnt = 0;
1887 6f97dba0 aliguori
    s->bufptr = 0;
1888 6f97dba0 aliguori
    chr->opaque = s;
1889 6f97dba0 aliguori
    chr->chr_write = udp_chr_write;
1890 6f97dba0 aliguori
    chr->chr_update_read_handler = udp_chr_update_read_handler;
1891 819f56b7 aliguori
    chr->chr_close = udp_chr_close;
1892 6f97dba0 aliguori
    return chr;
1893 6f97dba0 aliguori
1894 6f97dba0 aliguori
return_err:
1895 6f97dba0 aliguori
    if (chr)
1896 6f97dba0 aliguori
        free(chr);
1897 6f97dba0 aliguori
    if (s)
1898 6f97dba0 aliguori
        free(s);
1899 6f97dba0 aliguori
    if (fd >= 0)
1900 6f97dba0 aliguori
        closesocket(fd);
1901 6f97dba0 aliguori
    return NULL;
1902 6f97dba0 aliguori
}
1903 6f97dba0 aliguori
1904 6f97dba0 aliguori
/***********************************************************/
1905 6f97dba0 aliguori
/* TCP Net console */
1906 6f97dba0 aliguori
1907 6f97dba0 aliguori
typedef struct {
1908 6f97dba0 aliguori
    int fd, listen_fd;
1909 6f97dba0 aliguori
    int connected;
1910 6f97dba0 aliguori
    int max_size;
1911 6f97dba0 aliguori
    int do_telnetopt;
1912 6f97dba0 aliguori
    int do_nodelay;
1913 6f97dba0 aliguori
    int is_unix;
1914 7d174059 Mark McLoughlin
    int msgfd;
1915 6f97dba0 aliguori
} TCPCharDriver;
1916 6f97dba0 aliguori
1917 6f97dba0 aliguori
static void tcp_chr_accept(void *opaque);
1918 6f97dba0 aliguori
1919 6f97dba0 aliguori
static int tcp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1920 6f97dba0 aliguori
{
1921 6f97dba0 aliguori
    TCPCharDriver *s = chr->opaque;
1922 6f97dba0 aliguori
    if (s->connected) {
1923 6f97dba0 aliguori
        return send_all(s->fd, buf, len);
1924 6f97dba0 aliguori
    } else {
1925 6f97dba0 aliguori
        /* XXX: indicate an error ? */
1926 6f97dba0 aliguori
        return len;
1927 6f97dba0 aliguori
    }
1928 6f97dba0 aliguori
}
1929 6f97dba0 aliguori
1930 6f97dba0 aliguori
static int tcp_chr_read_poll(void *opaque)
1931 6f97dba0 aliguori
{
1932 6f97dba0 aliguori
    CharDriverState *chr = opaque;
1933 6f97dba0 aliguori
    TCPCharDriver *s = chr->opaque;
1934 6f97dba0 aliguori
    if (!s->connected)
1935 6f97dba0 aliguori
        return 0;
1936 6f97dba0 aliguori
    s->max_size = qemu_chr_can_read(chr);
1937 6f97dba0 aliguori
    return s->max_size;
1938 6f97dba0 aliguori
}
1939 6f97dba0 aliguori
1940 6f97dba0 aliguori
#define IAC 255
1941 6f97dba0 aliguori
#define IAC_BREAK 243
1942 6f97dba0 aliguori
static void tcp_chr_process_IAC_bytes(CharDriverState *chr,
1943 6f97dba0 aliguori
                                      TCPCharDriver *s,
1944 6f97dba0 aliguori
                                      uint8_t *buf, int *size)
1945 6f97dba0 aliguori
{
1946 6f97dba0 aliguori
    /* Handle any telnet client's basic IAC options to satisfy char by
1947 6f97dba0 aliguori
     * char mode with no echo.  All IAC options will be removed from
1948 6f97dba0 aliguori
     * the buf and the do_telnetopt variable will be used to track the
1949 6f97dba0 aliguori
     * state of the width of the IAC information.
1950 6f97dba0 aliguori
     *
1951 6f97dba0 aliguori
     * IAC commands come in sets of 3 bytes with the exception of the
1952 6f97dba0 aliguori
     * "IAC BREAK" command and the double IAC.
1953 6f97dba0 aliguori
     */
1954 6f97dba0 aliguori
1955 6f97dba0 aliguori
    int i;
1956 6f97dba0 aliguori
    int j = 0;
1957 6f97dba0 aliguori
1958 6f97dba0 aliguori
    for (i = 0; i < *size; i++) {
1959 6f97dba0 aliguori
        if (s->do_telnetopt > 1) {
1960 6f97dba0 aliguori
            if ((unsigned char)buf[i] == IAC && s->do_telnetopt == 2) {
1961 6f97dba0 aliguori
                /* Double IAC means send an IAC */
1962 6f97dba0 aliguori
                if (j != i)
1963 6f97dba0 aliguori
                    buf[j] = buf[i];
1964 6f97dba0 aliguori
                j++;
1965 6f97dba0 aliguori
                s->do_telnetopt = 1;
1966 6f97dba0 aliguori
            } else {
1967 6f97dba0 aliguori
                if ((unsigned char)buf[i] == IAC_BREAK && s->do_telnetopt == 2) {
1968 6f97dba0 aliguori
                    /* Handle IAC break commands by sending a serial break */
1969 6f97dba0 aliguori
                    qemu_chr_event(chr, CHR_EVENT_BREAK);
1970 6f97dba0 aliguori
                    s->do_telnetopt++;
1971 6f97dba0 aliguori
                }
1972 6f97dba0 aliguori
                s->do_telnetopt++;
1973 6f97dba0 aliguori
            }
1974 6f97dba0 aliguori
            if (s->do_telnetopt >= 4) {
1975 6f97dba0 aliguori
                s->do_telnetopt = 1;
1976 6f97dba0 aliguori
            }
1977 6f97dba0 aliguori
        } else {
1978 6f97dba0 aliguori
            if ((unsigned char)buf[i] == IAC) {
1979 6f97dba0 aliguori
                s->do_telnetopt = 2;
1980 6f97dba0 aliguori
            } else {
1981 6f97dba0 aliguori
                if (j != i)
1982 6f97dba0 aliguori
                    buf[j] = buf[i];
1983 6f97dba0 aliguori
                j++;
1984 6f97dba0 aliguori
            }
1985 6f97dba0 aliguori
        }
1986 6f97dba0 aliguori
    }
1987 6f97dba0 aliguori
    *size = j;
1988 6f97dba0 aliguori
}
1989 6f97dba0 aliguori
1990 7d174059 Mark McLoughlin
static int tcp_get_msgfd(CharDriverState *chr)
1991 7d174059 Mark McLoughlin
{
1992 7d174059 Mark McLoughlin
    TCPCharDriver *s = chr->opaque;
1993 e53f27b9 Paolo Bonzini
    int fd = s->msgfd;
1994 e53f27b9 Paolo Bonzini
    s->msgfd = -1;
1995 e53f27b9 Paolo Bonzini
    return fd;
1996 7d174059 Mark McLoughlin
}
1997 7d174059 Mark McLoughlin
1998 73bcc2ac Anthony Liguori
#ifndef _WIN32
1999 7d174059 Mark McLoughlin
static void unix_process_msgfd(CharDriverState *chr, struct msghdr *msg)
2000 7d174059 Mark McLoughlin
{
2001 7d174059 Mark McLoughlin
    TCPCharDriver *s = chr->opaque;
2002 7d174059 Mark McLoughlin
    struct cmsghdr *cmsg;
2003 7d174059 Mark McLoughlin
2004 7d174059 Mark McLoughlin
    for (cmsg = CMSG_FIRSTHDR(msg); cmsg; cmsg = CMSG_NXTHDR(msg, cmsg)) {
2005 7d174059 Mark McLoughlin
        int fd;
2006 7d174059 Mark McLoughlin
2007 7d174059 Mark McLoughlin
        if (cmsg->cmsg_len != CMSG_LEN(sizeof(int)) ||
2008 7d174059 Mark McLoughlin
            cmsg->cmsg_level != SOL_SOCKET ||
2009 7d174059 Mark McLoughlin
            cmsg->cmsg_type != SCM_RIGHTS)
2010 7d174059 Mark McLoughlin
            continue;
2011 7d174059 Mark McLoughlin
2012 7d174059 Mark McLoughlin
        fd = *((int *)CMSG_DATA(cmsg));
2013 7d174059 Mark McLoughlin
        if (fd < 0)
2014 7d174059 Mark McLoughlin
            continue;
2015 7d174059 Mark McLoughlin
2016 7d174059 Mark McLoughlin
        if (s->msgfd != -1)
2017 7d174059 Mark McLoughlin
            close(s->msgfd);
2018 7d174059 Mark McLoughlin
        s->msgfd = fd;
2019 7d174059 Mark McLoughlin
    }
2020 7d174059 Mark McLoughlin
}
2021 7d174059 Mark McLoughlin
2022 9977c894 Mark McLoughlin
static ssize_t tcp_chr_recv(CharDriverState *chr, char *buf, size_t len)
2023 9977c894 Mark McLoughlin
{
2024 9977c894 Mark McLoughlin
    TCPCharDriver *s = chr->opaque;
2025 7cba04f6 Blue Swirl
    struct msghdr msg = { NULL, };
2026 9977c894 Mark McLoughlin
    struct iovec iov[1];
2027 7d174059 Mark McLoughlin
    union {
2028 7d174059 Mark McLoughlin
        struct cmsghdr cmsg;
2029 7d174059 Mark McLoughlin
        char control[CMSG_SPACE(sizeof(int))];
2030 7d174059 Mark McLoughlin
    } msg_control;
2031 7d174059 Mark McLoughlin
    ssize_t ret;
2032 9977c894 Mark McLoughlin
2033 9977c894 Mark McLoughlin
    iov[0].iov_base = buf;
2034 9977c894 Mark McLoughlin
    iov[0].iov_len = len;
2035 9977c894 Mark McLoughlin
2036 9977c894 Mark McLoughlin
    msg.msg_iov = iov;
2037 9977c894 Mark McLoughlin
    msg.msg_iovlen = 1;
2038 7d174059 Mark McLoughlin
    msg.msg_control = &msg_control;
2039 7d174059 Mark McLoughlin
    msg.msg_controllen = sizeof(msg_control);
2040 7d174059 Mark McLoughlin
2041 7d174059 Mark McLoughlin
    ret = recvmsg(s->fd, &msg, 0);
2042 7d174059 Mark McLoughlin
    if (ret > 0 && s->is_unix)
2043 7d174059 Mark McLoughlin
        unix_process_msgfd(chr, &msg);
2044 9977c894 Mark McLoughlin
2045 7d174059 Mark McLoughlin
    return ret;
2046 9977c894 Mark McLoughlin
}
2047 9977c894 Mark McLoughlin
#else
2048 9977c894 Mark McLoughlin
static ssize_t tcp_chr_recv(CharDriverState *chr, char *buf, size_t len)
2049 9977c894 Mark McLoughlin
{
2050 9977c894 Mark McLoughlin
    TCPCharDriver *s = chr->opaque;
2051 9977c894 Mark McLoughlin
    return recv(s->fd, buf, len, 0);
2052 9977c894 Mark McLoughlin
}
2053 9977c894 Mark McLoughlin
#endif
2054 9977c894 Mark McLoughlin
2055 6f97dba0 aliguori
static void tcp_chr_read(void *opaque)
2056 6f97dba0 aliguori
{
2057 6f97dba0 aliguori
    CharDriverState *chr = opaque;
2058 6f97dba0 aliguori
    TCPCharDriver *s = chr->opaque;
2059 9bd7854e Amit Shah
    uint8_t buf[READ_BUF_LEN];
2060 6f97dba0 aliguori
    int len, size;
2061 6f97dba0 aliguori
2062 6f97dba0 aliguori
    if (!s->connected || s->max_size <= 0)
2063 6f97dba0 aliguori
        return;
2064 6f97dba0 aliguori
    len = sizeof(buf);
2065 6f97dba0 aliguori
    if (len > s->max_size)
2066 6f97dba0 aliguori
        len = s->max_size;
2067 9977c894 Mark McLoughlin
    size = tcp_chr_recv(chr, (void *)buf, len);
2068 6f97dba0 aliguori
    if (size == 0) {
2069 6f97dba0 aliguori
        /* connection closed */
2070 6f97dba0 aliguori
        s->connected = 0;
2071 6f97dba0 aliguori
        if (s->listen_fd >= 0) {
2072 6f97dba0 aliguori
            qemu_set_fd_handler(s->listen_fd, tcp_chr_accept, NULL, chr);
2073 6f97dba0 aliguori
        }
2074 6f97dba0 aliguori
        qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
2075 6f97dba0 aliguori
        closesocket(s->fd);
2076 6f97dba0 aliguori
        s->fd = -1;
2077 793cbfb5 Amit Shah
        qemu_chr_event(chr, CHR_EVENT_CLOSED);
2078 6f97dba0 aliguori
    } else if (size > 0) {
2079 6f97dba0 aliguori
        if (s->do_telnetopt)
2080 6f97dba0 aliguori
            tcp_chr_process_IAC_bytes(chr, s, buf, &size);
2081 6f97dba0 aliguori
        if (size > 0)
2082 6f97dba0 aliguori
            qemu_chr_read(chr, buf, size);
2083 6f97dba0 aliguori
    }
2084 6f97dba0 aliguori
}
2085 6f97dba0 aliguori
2086 68c18d1c Blue Swirl
#ifndef _WIN32
2087 68c18d1c Blue Swirl
CharDriverState *qemu_chr_open_eventfd(int eventfd)
2088 68c18d1c Blue Swirl
{
2089 6cbf4c8c Cam Macdonell
    return qemu_chr_open_fd(eventfd, eventfd);
2090 6cbf4c8c Cam Macdonell
}
2091 68c18d1c Blue Swirl
#endif
2092 6cbf4c8c Cam Macdonell
2093 6f97dba0 aliguori
static void tcp_chr_connect(void *opaque)
2094 6f97dba0 aliguori
{
2095 6f97dba0 aliguori
    CharDriverState *chr = opaque;
2096 6f97dba0 aliguori
    TCPCharDriver *s = chr->opaque;
2097 6f97dba0 aliguori
2098 6f97dba0 aliguori
    s->connected = 1;
2099 6f97dba0 aliguori
    qemu_set_fd_handler2(s->fd, tcp_chr_read_poll,
2100 6f97dba0 aliguori
                         tcp_chr_read, NULL, chr);
2101 127338e6 Amit Shah
    qemu_chr_generic_open(chr);
2102 6f97dba0 aliguori
}
2103 6f97dba0 aliguori
2104 6f97dba0 aliguori
#define IACSET(x,a,b,c) x[0] = a; x[1] = b; x[2] = c;
2105 6f97dba0 aliguori
static void tcp_chr_telnet_init(int fd)
2106 6f97dba0 aliguori
{
2107 6f97dba0 aliguori
    char buf[3];
2108 6f97dba0 aliguori
    /* Send the telnet negotion to put telnet in binary, no echo, single char mode */
2109 6f97dba0 aliguori
    IACSET(buf, 0xff, 0xfb, 0x01);  /* IAC WILL ECHO */
2110 6f97dba0 aliguori
    send(fd, (char *)buf, 3, 0);
2111 6f97dba0 aliguori
    IACSET(buf, 0xff, 0xfb, 0x03);  /* IAC WILL Suppress go ahead */
2112 6f97dba0 aliguori
    send(fd, (char *)buf, 3, 0);
2113 6f97dba0 aliguori
    IACSET(buf, 0xff, 0xfb, 0x00);  /* IAC WILL Binary */
2114 6f97dba0 aliguori
    send(fd, (char *)buf, 3, 0);
2115 6f97dba0 aliguori
    IACSET(buf, 0xff, 0xfd, 0x00);  /* IAC DO Binary */
2116 6f97dba0 aliguori
    send(fd, (char *)buf, 3, 0);
2117 6f97dba0 aliguori
}
2118 6f97dba0 aliguori
2119 6f97dba0 aliguori
static void socket_set_nodelay(int fd)
2120 6f97dba0 aliguori
{
2121 6f97dba0 aliguori
    int val = 1;
2122 6f97dba0 aliguori
    setsockopt(fd, IPPROTO_TCP, TCP_NODELAY, (char *)&val, sizeof(val));
2123 6f97dba0 aliguori
}
2124 6f97dba0 aliguori
2125 6f97dba0 aliguori
static void tcp_chr_accept(void *opaque)
2126 6f97dba0 aliguori
{
2127 6f97dba0 aliguori
    CharDriverState *chr = opaque;
2128 6f97dba0 aliguori
    TCPCharDriver *s = chr->opaque;
2129 6f97dba0 aliguori
    struct sockaddr_in saddr;
2130 6f97dba0 aliguori
#ifndef _WIN32
2131 6f97dba0 aliguori
    struct sockaddr_un uaddr;
2132 6f97dba0 aliguori
#endif
2133 6f97dba0 aliguori
    struct sockaddr *addr;
2134 6f97dba0 aliguori
    socklen_t len;
2135 6f97dba0 aliguori
    int fd;
2136 6f97dba0 aliguori
2137 6f97dba0 aliguori
    for(;;) {
2138 6f97dba0 aliguori
#ifndef _WIN32
2139 6f97dba0 aliguori
        if (s->is_unix) {
2140 6f97dba0 aliguori
            len = sizeof(uaddr);
2141 6f97dba0 aliguori
            addr = (struct sockaddr *)&uaddr;
2142 6f97dba0 aliguori
        } else
2143 6f97dba0 aliguori
#endif
2144 6f97dba0 aliguori
        {
2145 6f97dba0 aliguori
            len = sizeof(saddr);
2146 6f97dba0 aliguori
            addr = (struct sockaddr *)&saddr;
2147 6f97dba0 aliguori
        }
2148 40ff6d7e Kevin Wolf
        fd = qemu_accept(s->listen_fd, addr, &len);
2149 6f97dba0 aliguori
        if (fd < 0 && errno != EINTR) {
2150 6f97dba0 aliguori
            return;
2151 6f97dba0 aliguori
        } else if (fd >= 0) {
2152 6f97dba0 aliguori
            if (s->do_telnetopt)
2153 6f97dba0 aliguori
                tcp_chr_telnet_init(fd);
2154 6f97dba0 aliguori
            break;
2155 6f97dba0 aliguori
        }
2156 6f97dba0 aliguori
    }
2157 6f97dba0 aliguori
    socket_set_nonblock(fd);
2158 6f97dba0 aliguori
    if (s->do_nodelay)
2159 6f97dba0 aliguori
        socket_set_nodelay(fd);
2160 6f97dba0 aliguori
    s->fd = fd;
2161 6f97dba0 aliguori
    qemu_set_fd_handler(s->listen_fd, NULL, NULL, NULL);
2162 6f97dba0 aliguori
    tcp_chr_connect(chr);
2163 6f97dba0 aliguori
}
2164 6f97dba0 aliguori
2165 6f97dba0 aliguori
static void tcp_chr_close(CharDriverState *chr)
2166 6f97dba0 aliguori
{
2167 6f97dba0 aliguori
    TCPCharDriver *s = chr->opaque;
2168 819f56b7 aliguori
    if (s->fd >= 0) {
2169 819f56b7 aliguori
        qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
2170 6f97dba0 aliguori
        closesocket(s->fd);
2171 819f56b7 aliguori
    }
2172 819f56b7 aliguori
    if (s->listen_fd >= 0) {
2173 819f56b7 aliguori
        qemu_set_fd_handler(s->listen_fd, NULL, NULL, NULL);
2174 6f97dba0 aliguori
        closesocket(s->listen_fd);
2175 819f56b7 aliguori
    }
2176 6f97dba0 aliguori
    qemu_free(s);
2177 793cbfb5 Amit Shah
    qemu_chr_event(chr, CHR_EVENT_CLOSED);
2178 6f97dba0 aliguori
}
2179 6f97dba0 aliguori
2180 aeb2c47a Gerd Hoffmann
static CharDriverState *qemu_chr_open_socket(QemuOpts *opts)
2181 6f97dba0 aliguori
{
2182 6f97dba0 aliguori
    CharDriverState *chr = NULL;
2183 6f97dba0 aliguori
    TCPCharDriver *s = NULL;
2184 aeb2c47a Gerd Hoffmann
    int fd = -1;
2185 aeb2c47a Gerd Hoffmann
    int is_listen;
2186 aeb2c47a Gerd Hoffmann
    int is_waitconnect;
2187 aeb2c47a Gerd Hoffmann
    int do_nodelay;
2188 aeb2c47a Gerd Hoffmann
    int is_unix;
2189 aeb2c47a Gerd Hoffmann
    int is_telnet;
2190 aeb2c47a Gerd Hoffmann
2191 aeb2c47a Gerd Hoffmann
    is_listen      = qemu_opt_get_bool(opts, "server", 0);
2192 aeb2c47a Gerd Hoffmann
    is_waitconnect = qemu_opt_get_bool(opts, "wait", 1);
2193 aeb2c47a Gerd Hoffmann
    is_telnet      = qemu_opt_get_bool(opts, "telnet", 0);
2194 aeb2c47a Gerd Hoffmann
    do_nodelay     = !qemu_opt_get_bool(opts, "delay", 1);
2195 aeb2c47a Gerd Hoffmann
    is_unix        = qemu_opt_get(opts, "path") != NULL;
2196 6f97dba0 aliguori
    if (!is_listen)
2197 6f97dba0 aliguori
        is_waitconnect = 0;
2198 6f97dba0 aliguori
2199 6f97dba0 aliguori
    chr = qemu_mallocz(sizeof(CharDriverState));
2200 6f97dba0 aliguori
    s = qemu_mallocz(sizeof(TCPCharDriver));
2201 6f97dba0 aliguori
2202 f07b6003 aliguori
    if (is_unix) {
2203 f07b6003 aliguori
        if (is_listen) {
2204 aeb2c47a Gerd Hoffmann
            fd = unix_listen_opts(opts);
2205 f07b6003 aliguori
        } else {
2206 aeb2c47a Gerd Hoffmann
            fd = unix_connect_opts(opts);
2207 f07b6003 aliguori
        }
2208 f07b6003 aliguori
    } else {
2209 f07b6003 aliguori
        if (is_listen) {
2210 aeb2c47a Gerd Hoffmann
            fd = inet_listen_opts(opts, 0);
2211 f07b6003 aliguori
        } else {
2212 aeb2c47a Gerd Hoffmann
            fd = inet_connect_opts(opts);
2213 f07b6003 aliguori
        }
2214 f07b6003 aliguori
    }
2215 6f97dba0 aliguori
    if (fd < 0)
2216 6f97dba0 aliguori
        goto fail;
2217 6f97dba0 aliguori
2218 6f97dba0 aliguori
    if (!is_waitconnect)
2219 6f97dba0 aliguori
        socket_set_nonblock(fd);
2220 6f97dba0 aliguori
2221 6f97dba0 aliguori
    s->connected = 0;
2222 6f97dba0 aliguori
    s->fd = -1;
2223 6f97dba0 aliguori
    s->listen_fd = -1;
2224 7d174059 Mark McLoughlin
    s->msgfd = -1;
2225 6f97dba0 aliguori
    s->is_unix = is_unix;
2226 6f97dba0 aliguori
    s->do_nodelay = do_nodelay && !is_unix;
2227 6f97dba0 aliguori
2228 6f97dba0 aliguori
    chr->opaque = s;
2229 6f97dba0 aliguori
    chr->chr_write = tcp_chr_write;
2230 6f97dba0 aliguori
    chr->chr_close = tcp_chr_close;
2231 7d174059 Mark McLoughlin
    chr->get_msgfd = tcp_get_msgfd;
2232 6f97dba0 aliguori
2233 6f97dba0 aliguori
    if (is_listen) {
2234 6f97dba0 aliguori
        s->listen_fd = fd;
2235 6f97dba0 aliguori
        qemu_set_fd_handler(s->listen_fd, tcp_chr_accept, NULL, chr);
2236 6f97dba0 aliguori
        if (is_telnet)
2237 6f97dba0 aliguori
            s->do_telnetopt = 1;
2238 aeb2c47a Gerd Hoffmann
2239 6f97dba0 aliguori
    } else {
2240 f07b6003 aliguori
        s->connected = 1;
2241 6f97dba0 aliguori
        s->fd = fd;
2242 6f97dba0 aliguori
        socket_set_nodelay(fd);
2243 f07b6003 aliguori
        tcp_chr_connect(chr);
2244 6f97dba0 aliguori
    }
2245 6f97dba0 aliguori
2246 aeb2c47a Gerd Hoffmann
    /* for "info chardev" monitor command */
2247 aeb2c47a Gerd Hoffmann
    chr->filename = qemu_malloc(256);
2248 aeb2c47a Gerd Hoffmann
    if (is_unix) {
2249 aeb2c47a Gerd Hoffmann
        snprintf(chr->filename, 256, "unix:%s%s",
2250 aeb2c47a Gerd Hoffmann
                 qemu_opt_get(opts, "path"),
2251 aeb2c47a Gerd Hoffmann
                 qemu_opt_get_bool(opts, "server", 0) ? ",server" : "");
2252 aeb2c47a Gerd Hoffmann
    } else if (is_telnet) {
2253 aeb2c47a Gerd Hoffmann
        snprintf(chr->filename, 256, "telnet:%s:%s%s",
2254 aeb2c47a Gerd Hoffmann
                 qemu_opt_get(opts, "host"), qemu_opt_get(opts, "port"),
2255 aeb2c47a Gerd Hoffmann
                 qemu_opt_get_bool(opts, "server", 0) ? ",server" : "");
2256 aeb2c47a Gerd Hoffmann
    } else {
2257 aeb2c47a Gerd Hoffmann
        snprintf(chr->filename, 256, "tcp:%s:%s%s",
2258 aeb2c47a Gerd Hoffmann
                 qemu_opt_get(opts, "host"), qemu_opt_get(opts, "port"),
2259 aeb2c47a Gerd Hoffmann
                 qemu_opt_get_bool(opts, "server", 0) ? ",server" : "");
2260 aeb2c47a Gerd Hoffmann
    }
2261 aeb2c47a Gerd Hoffmann
2262 6f97dba0 aliguori
    if (is_listen && is_waitconnect) {
2263 f07b6003 aliguori
        printf("QEMU waiting for connection on: %s\n",
2264 aeb2c47a Gerd Hoffmann
               chr->filename);
2265 6f97dba0 aliguori
        tcp_chr_accept(chr);
2266 6f97dba0 aliguori
        socket_set_nonblock(s->listen_fd);
2267 6f97dba0 aliguori
    }
2268 6f97dba0 aliguori
    return chr;
2269 aeb2c47a Gerd Hoffmann
2270 6f97dba0 aliguori
 fail:
2271 6f97dba0 aliguori
    if (fd >= 0)
2272 6f97dba0 aliguori
        closesocket(fd);
2273 6f97dba0 aliguori
    qemu_free(s);
2274 6f97dba0 aliguori
    qemu_free(chr);
2275 6f97dba0 aliguori
    return NULL;
2276 6f97dba0 aliguori
}
2277 6f97dba0 aliguori
2278 999bd67c Luiz Capitulino
/***********************************************************/
2279 999bd67c Luiz Capitulino
/* Memory chardev */
2280 999bd67c Luiz Capitulino
typedef struct {
2281 999bd67c Luiz Capitulino
    size_t outbuf_size;
2282 999bd67c Luiz Capitulino
    size_t outbuf_capacity;
2283 999bd67c Luiz Capitulino
    uint8_t *outbuf;
2284 999bd67c Luiz Capitulino
} MemoryDriver;
2285 999bd67c Luiz Capitulino
2286 999bd67c Luiz Capitulino
static int mem_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2287 999bd67c Luiz Capitulino
{
2288 999bd67c Luiz Capitulino
    MemoryDriver *d = chr->opaque;
2289 999bd67c Luiz Capitulino
2290 999bd67c Luiz Capitulino
    /* TODO: the QString implementation has the same code, we should
2291 999bd67c Luiz Capitulino
     * introduce a generic way to do this in cutils.c */
2292 999bd67c Luiz Capitulino
    if (d->outbuf_capacity < d->outbuf_size + len) {
2293 999bd67c Luiz Capitulino
        /* grow outbuf */
2294 999bd67c Luiz Capitulino
        d->outbuf_capacity += len;
2295 999bd67c Luiz Capitulino
        d->outbuf_capacity *= 2;
2296 999bd67c Luiz Capitulino
        d->outbuf = qemu_realloc(d->outbuf, d->outbuf_capacity);
2297 999bd67c Luiz Capitulino
    }
2298 999bd67c Luiz Capitulino
2299 999bd67c Luiz Capitulino
    memcpy(d->outbuf + d->outbuf_size, buf, len);
2300 999bd67c Luiz Capitulino
    d->outbuf_size += len;
2301 999bd67c Luiz Capitulino
2302 999bd67c Luiz Capitulino
    return len;
2303 999bd67c Luiz Capitulino
}
2304 999bd67c Luiz Capitulino
2305 999bd67c Luiz Capitulino
void qemu_chr_init_mem(CharDriverState *chr)
2306 999bd67c Luiz Capitulino
{
2307 999bd67c Luiz Capitulino
    MemoryDriver *d;
2308 999bd67c Luiz Capitulino
2309 999bd67c Luiz Capitulino
    d = qemu_malloc(sizeof(*d));
2310 999bd67c Luiz Capitulino
    d->outbuf_size = 0;
2311 999bd67c Luiz Capitulino
    d->outbuf_capacity = 4096;
2312 999bd67c Luiz Capitulino
    d->outbuf = qemu_mallocz(d->outbuf_capacity);
2313 999bd67c Luiz Capitulino
2314 999bd67c Luiz Capitulino
    memset(chr, 0, sizeof(*chr));
2315 999bd67c Luiz Capitulino
    chr->opaque = d;
2316 999bd67c Luiz Capitulino
    chr->chr_write = mem_chr_write;
2317 999bd67c Luiz Capitulino
}
2318 999bd67c Luiz Capitulino
2319 999bd67c Luiz Capitulino
QString *qemu_chr_mem_to_qs(CharDriverState *chr)
2320 999bd67c Luiz Capitulino
{
2321 999bd67c Luiz Capitulino
    MemoryDriver *d = chr->opaque;
2322 999bd67c Luiz Capitulino
    return qstring_from_substr((char *) d->outbuf, 0, d->outbuf_size - 1);
2323 999bd67c Luiz Capitulino
}
2324 999bd67c Luiz Capitulino
2325 999bd67c Luiz Capitulino
/* NOTE: this driver can not be closed with qemu_chr_close()! */
2326 999bd67c Luiz Capitulino
void qemu_chr_close_mem(CharDriverState *chr)
2327 999bd67c Luiz Capitulino
{
2328 999bd67c Luiz Capitulino
    MemoryDriver *d = chr->opaque;
2329 999bd67c Luiz Capitulino
2330 999bd67c Luiz Capitulino
    qemu_free(d->outbuf);
2331 999bd67c Luiz Capitulino
    qemu_free(chr->opaque);
2332 999bd67c Luiz Capitulino
    chr->opaque = NULL;
2333 999bd67c Luiz Capitulino
    chr->chr_write = NULL;
2334 999bd67c Luiz Capitulino
}
2335 999bd67c Luiz Capitulino
2336 999bd67c Luiz Capitulino
size_t qemu_chr_mem_osize(const CharDriverState *chr)
2337 999bd67c Luiz Capitulino
{
2338 999bd67c Luiz Capitulino
    const MemoryDriver *d = chr->opaque;
2339 999bd67c Luiz Capitulino
    return d->outbuf_size;
2340 999bd67c Luiz Capitulino
}
2341 999bd67c Luiz Capitulino
2342 33521634 Gerd Hoffmann
QemuOpts *qemu_chr_parse_compat(const char *label, const char *filename)
2343 191bc01b Gerd Hoffmann
{
2344 6ea314d9 Gerd Hoffmann
    char host[65], port[33], width[8], height[8];
2345 aeb2c47a Gerd Hoffmann
    int pos;
2346 7d31544f Gerd Hoffmann
    const char *p;
2347 191bc01b Gerd Hoffmann
    QemuOpts *opts;
2348 191bc01b Gerd Hoffmann
2349 3329f07b Gerd Hoffmann
    opts = qemu_opts_create(qemu_find_opts("chardev"), label, 1);
2350 191bc01b Gerd Hoffmann
    if (NULL == opts)
2351 191bc01b Gerd Hoffmann
        return NULL;
2352 191bc01b Gerd Hoffmann
2353 7591c5c1 Gerd Hoffmann
    if (strstart(filename, "mon:", &p)) {
2354 7591c5c1 Gerd Hoffmann
        filename = p;
2355 7591c5c1 Gerd Hoffmann
        qemu_opt_set(opts, "mux", "on");
2356 7591c5c1 Gerd Hoffmann
    }
2357 7591c5c1 Gerd Hoffmann
2358 f0457e8d Gerd Hoffmann
    if (strcmp(filename, "null")    == 0 ||
2359 f0457e8d Gerd Hoffmann
        strcmp(filename, "pty")     == 0 ||
2360 f0457e8d Gerd Hoffmann
        strcmp(filename, "msmouse") == 0 ||
2361 dc1c21e6 Gerd Hoffmann
        strcmp(filename, "braille") == 0 ||
2362 f0457e8d Gerd Hoffmann
        strcmp(filename, "stdio")   == 0) {
2363 4490dadf Gerd Hoffmann
        qemu_opt_set(opts, "backend", filename);
2364 191bc01b Gerd Hoffmann
        return opts;
2365 191bc01b Gerd Hoffmann
    }
2366 6ea314d9 Gerd Hoffmann
    if (strstart(filename, "vc", &p)) {
2367 6ea314d9 Gerd Hoffmann
        qemu_opt_set(opts, "backend", "vc");
2368 6ea314d9 Gerd Hoffmann
        if (*p == ':') {
2369 6ea314d9 Gerd Hoffmann
            if (sscanf(p+1, "%8[0-9]x%8[0-9]", width, height) == 2) {
2370 6ea314d9 Gerd Hoffmann
                /* pixels */
2371 6ea314d9 Gerd Hoffmann
                qemu_opt_set(opts, "width", width);
2372 6ea314d9 Gerd Hoffmann
                qemu_opt_set(opts, "height", height);
2373 6ea314d9 Gerd Hoffmann
            } else if (sscanf(p+1, "%8[0-9]Cx%8[0-9]C", width, height) == 2) {
2374 6ea314d9 Gerd Hoffmann
                /* chars */
2375 6ea314d9 Gerd Hoffmann
                qemu_opt_set(opts, "cols", width);
2376 6ea314d9 Gerd Hoffmann
                qemu_opt_set(opts, "rows", height);
2377 6ea314d9 Gerd Hoffmann
            } else {
2378 6ea314d9 Gerd Hoffmann
                goto fail;
2379 6ea314d9 Gerd Hoffmann
            }
2380 6ea314d9 Gerd Hoffmann
        }
2381 6ea314d9 Gerd Hoffmann
        return opts;
2382 6ea314d9 Gerd Hoffmann
    }
2383 d6c983cd Gerd Hoffmann
    if (strcmp(filename, "con:") == 0) {
2384 d6c983cd Gerd Hoffmann
        qemu_opt_set(opts, "backend", "console");
2385 d6c983cd Gerd Hoffmann
        return opts;
2386 d6c983cd Gerd Hoffmann
    }
2387 48b76496 Gerd Hoffmann
    if (strstart(filename, "COM", NULL)) {
2388 48b76496 Gerd Hoffmann
        qemu_opt_set(opts, "backend", "serial");
2389 48b76496 Gerd Hoffmann
        qemu_opt_set(opts, "path", filename);
2390 48b76496 Gerd Hoffmann
        return opts;
2391 48b76496 Gerd Hoffmann
    }
2392 7d31544f Gerd Hoffmann
    if (strstart(filename, "file:", &p)) {
2393 7d31544f Gerd Hoffmann
        qemu_opt_set(opts, "backend", "file");
2394 7d31544f Gerd Hoffmann
        qemu_opt_set(opts, "path", p);
2395 7d31544f Gerd Hoffmann
        return opts;
2396 7d31544f Gerd Hoffmann
    }
2397 7d31544f Gerd Hoffmann
    if (strstart(filename, "pipe:", &p)) {
2398 7d31544f Gerd Hoffmann
        qemu_opt_set(opts, "backend", "pipe");
2399 7d31544f Gerd Hoffmann
        qemu_opt_set(opts, "path", p);
2400 7d31544f Gerd Hoffmann
        return opts;
2401 7d31544f Gerd Hoffmann
    }
2402 aeb2c47a Gerd Hoffmann
    if (strstart(filename, "tcp:", &p) ||
2403 aeb2c47a Gerd Hoffmann
        strstart(filename, "telnet:", &p)) {
2404 aeb2c47a Gerd Hoffmann
        if (sscanf(p, "%64[^:]:%32[^,]%n", host, port, &pos) < 2) {
2405 aeb2c47a Gerd Hoffmann
            host[0] = 0;
2406 aeb2c47a Gerd Hoffmann
            if (sscanf(p, ":%32[^,]%n", port, &pos) < 1)
2407 aeb2c47a Gerd Hoffmann
                goto fail;
2408 aeb2c47a Gerd Hoffmann
        }
2409 aeb2c47a Gerd Hoffmann
        qemu_opt_set(opts, "backend", "socket");
2410 aeb2c47a Gerd Hoffmann
        qemu_opt_set(opts, "host", host);
2411 aeb2c47a Gerd Hoffmann
        qemu_opt_set(opts, "port", port);
2412 aeb2c47a Gerd Hoffmann
        if (p[pos] == ',') {
2413 aeb2c47a Gerd Hoffmann
            if (qemu_opts_do_parse(opts, p+pos+1, NULL) != 0)
2414 aeb2c47a Gerd Hoffmann
                goto fail;
2415 aeb2c47a Gerd Hoffmann
        }
2416 aeb2c47a Gerd Hoffmann
        if (strstart(filename, "telnet:", &p))
2417 aeb2c47a Gerd Hoffmann
            qemu_opt_set(opts, "telnet", "on");
2418 aeb2c47a Gerd Hoffmann
        return opts;
2419 aeb2c47a Gerd Hoffmann
    }
2420 7e1b35b4 Gerd Hoffmann
    if (strstart(filename, "udp:", &p)) {
2421 7e1b35b4 Gerd Hoffmann
        qemu_opt_set(opts, "backend", "udp");
2422 7e1b35b4 Gerd Hoffmann
        if (sscanf(p, "%64[^:]:%32[^@,]%n", host, port, &pos) < 2) {
2423 7e1b35b4 Gerd Hoffmann
            host[0] = 0;
2424 39324ca4 Jan Kiszka
            if (sscanf(p, ":%32[^@,]%n", port, &pos) < 1) {
2425 7e1b35b4 Gerd Hoffmann
                goto fail;
2426 7e1b35b4 Gerd Hoffmann
            }
2427 7e1b35b4 Gerd Hoffmann
        }
2428 7e1b35b4 Gerd Hoffmann
        qemu_opt_set(opts, "host", host);
2429 7e1b35b4 Gerd Hoffmann
        qemu_opt_set(opts, "port", port);
2430 7e1b35b4 Gerd Hoffmann
        if (p[pos] == '@') {
2431 7e1b35b4 Gerd Hoffmann
            p += pos + 1;
2432 7e1b35b4 Gerd Hoffmann
            if (sscanf(p, "%64[^:]:%32[^,]%n", host, port, &pos) < 2) {
2433 7e1b35b4 Gerd Hoffmann
                host[0] = 0;
2434 7e1b35b4 Gerd Hoffmann
                if (sscanf(p, ":%32[^,]%n", port, &pos) < 1) {
2435 7e1b35b4 Gerd Hoffmann
                    goto fail;
2436 7e1b35b4 Gerd Hoffmann
                }
2437 7e1b35b4 Gerd Hoffmann
            }
2438 7e1b35b4 Gerd Hoffmann
            qemu_opt_set(opts, "localaddr", host);
2439 7e1b35b4 Gerd Hoffmann
            qemu_opt_set(opts, "localport", port);
2440 7e1b35b4 Gerd Hoffmann
        }
2441 7e1b35b4 Gerd Hoffmann
        return opts;
2442 7e1b35b4 Gerd Hoffmann
    }
2443 aeb2c47a Gerd Hoffmann
    if (strstart(filename, "unix:", &p)) {
2444 aeb2c47a Gerd Hoffmann
        qemu_opt_set(opts, "backend", "socket");
2445 aeb2c47a Gerd Hoffmann
        if (qemu_opts_do_parse(opts, p, "path") != 0)
2446 aeb2c47a Gerd Hoffmann
            goto fail;
2447 aeb2c47a Gerd Hoffmann
        return opts;
2448 aeb2c47a Gerd Hoffmann
    }
2449 48b76496 Gerd Hoffmann
    if (strstart(filename, "/dev/parport", NULL) ||
2450 48b76496 Gerd Hoffmann
        strstart(filename, "/dev/ppi", NULL)) {
2451 48b76496 Gerd Hoffmann
        qemu_opt_set(opts, "backend", "parport");
2452 48b76496 Gerd Hoffmann
        qemu_opt_set(opts, "path", filename);
2453 48b76496 Gerd Hoffmann
        return opts;
2454 48b76496 Gerd Hoffmann
    }
2455 48b76496 Gerd Hoffmann
    if (strstart(filename, "/dev/", NULL)) {
2456 48b76496 Gerd Hoffmann
        qemu_opt_set(opts, "backend", "tty");
2457 48b76496 Gerd Hoffmann
        qemu_opt_set(opts, "path", filename);
2458 48b76496 Gerd Hoffmann
        return opts;
2459 48b76496 Gerd Hoffmann
    }
2460 191bc01b Gerd Hoffmann
2461 aeb2c47a Gerd Hoffmann
fail:
2462 191bc01b Gerd Hoffmann
    qemu_opts_del(opts);
2463 191bc01b Gerd Hoffmann
    return NULL;
2464 191bc01b Gerd Hoffmann
}
2465 191bc01b Gerd Hoffmann
2466 191bc01b Gerd Hoffmann
static const struct {
2467 191bc01b Gerd Hoffmann
    const char *name;
2468 191bc01b Gerd Hoffmann
    CharDriverState *(*open)(QemuOpts *opts);
2469 191bc01b Gerd Hoffmann
} backend_table[] = {
2470 191bc01b Gerd Hoffmann
    { .name = "null",      .open = qemu_chr_open_null },
2471 aeb2c47a Gerd Hoffmann
    { .name = "socket",    .open = qemu_chr_open_socket },
2472 7e1b35b4 Gerd Hoffmann
    { .name = "udp",       .open = qemu_chr_open_udp },
2473 f0457e8d Gerd Hoffmann
    { .name = "msmouse",   .open = qemu_chr_open_msmouse },
2474 6ea314d9 Gerd Hoffmann
    { .name = "vc",        .open = text_console_init },
2475 7d31544f Gerd Hoffmann
#ifdef _WIN32
2476 7d31544f Gerd Hoffmann
    { .name = "file",      .open = qemu_chr_open_win_file_out },
2477 7d31544f Gerd Hoffmann
    { .name = "pipe",      .open = qemu_chr_open_win_pipe },
2478 d6c983cd Gerd Hoffmann
    { .name = "console",   .open = qemu_chr_open_win_con },
2479 48b76496 Gerd Hoffmann
    { .name = "serial",    .open = qemu_chr_open_win },
2480 7d31544f Gerd Hoffmann
#else
2481 7d31544f Gerd Hoffmann
    { .name = "file",      .open = qemu_chr_open_file_out },
2482 7d31544f Gerd Hoffmann
    { .name = "pipe",      .open = qemu_chr_open_pipe },
2483 4490dadf Gerd Hoffmann
    { .name = "pty",       .open = qemu_chr_open_pty },
2484 3c17affb Gerd Hoffmann
    { .name = "stdio",     .open = qemu_chr_open_stdio },
2485 7d31544f Gerd Hoffmann
#endif
2486 dc1c21e6 Gerd Hoffmann
#ifdef CONFIG_BRLAPI
2487 dc1c21e6 Gerd Hoffmann
    { .name = "braille",   .open = chr_baum_init },
2488 dc1c21e6 Gerd Hoffmann
#endif
2489 48b76496 Gerd Hoffmann
#if defined(__linux__) || defined(__sun__) || defined(__FreeBSD__) \
2490 a167ba50 Aurelien Jarno
    || defined(__NetBSD__) || defined(__OpenBSD__) || defined(__DragonFly__) \
2491 a167ba50 Aurelien Jarno
    || defined(__FreeBSD_kernel__)
2492 48b76496 Gerd Hoffmann
    { .name = "tty",       .open = qemu_chr_open_tty },
2493 48b76496 Gerd Hoffmann
#endif
2494 a167ba50 Aurelien Jarno
#if defined(__linux__) || defined(__FreeBSD__) || defined(__DragonFly__) \
2495 a167ba50 Aurelien Jarno
    || defined(__FreeBSD_kernel__)
2496 48b76496 Gerd Hoffmann
    { .name = "parport",   .open = qemu_chr_open_pp },
2497 48b76496 Gerd Hoffmann
#endif
2498 191bc01b Gerd Hoffmann
};
2499 191bc01b Gerd Hoffmann
2500 191bc01b Gerd Hoffmann
CharDriverState *qemu_chr_open_opts(QemuOpts *opts,
2501 191bc01b Gerd Hoffmann
                                    void (*init)(struct CharDriverState *s))
2502 191bc01b Gerd Hoffmann
{
2503 191bc01b Gerd Hoffmann
    CharDriverState *chr;
2504 191bc01b Gerd Hoffmann
    int i;
2505 191bc01b Gerd Hoffmann
2506 191bc01b Gerd Hoffmann
    if (qemu_opts_id(opts) == NULL) {
2507 191bc01b Gerd Hoffmann
        fprintf(stderr, "chardev: no id specified\n");
2508 191bc01b Gerd Hoffmann
        return NULL;
2509 191bc01b Gerd Hoffmann
    }
2510 191bc01b Gerd Hoffmann
2511 191bc01b Gerd Hoffmann
    for (i = 0; i < ARRAY_SIZE(backend_table); i++) {
2512 191bc01b Gerd Hoffmann
        if (strcmp(backend_table[i].name, qemu_opt_get(opts, "backend")) == 0)
2513 191bc01b Gerd Hoffmann
            break;
2514 191bc01b Gerd Hoffmann
    }
2515 191bc01b Gerd Hoffmann
    if (i == ARRAY_SIZE(backend_table)) {
2516 191bc01b Gerd Hoffmann
        fprintf(stderr, "chardev: backend \"%s\" not found\n",
2517 191bc01b Gerd Hoffmann
                qemu_opt_get(opts, "backend"));
2518 191bc01b Gerd Hoffmann
        return NULL;
2519 191bc01b Gerd Hoffmann
    }
2520 191bc01b Gerd Hoffmann
2521 191bc01b Gerd Hoffmann
    chr = backend_table[i].open(opts);
2522 191bc01b Gerd Hoffmann
    if (!chr) {
2523 191bc01b Gerd Hoffmann
        fprintf(stderr, "chardev: opening backend \"%s\" failed\n",
2524 191bc01b Gerd Hoffmann
                qemu_opt_get(opts, "backend"));
2525 191bc01b Gerd Hoffmann
        return NULL;
2526 191bc01b Gerd Hoffmann
    }
2527 191bc01b Gerd Hoffmann
2528 191bc01b Gerd Hoffmann
    if (!chr->filename)
2529 191bc01b Gerd Hoffmann
        chr->filename = qemu_strdup(qemu_opt_get(opts, "backend"));
2530 191bc01b Gerd Hoffmann
    chr->init = init;
2531 72cf2d4f Blue Swirl
    QTAILQ_INSERT_TAIL(&chardevs, chr, next);
2532 7591c5c1 Gerd Hoffmann
2533 7591c5c1 Gerd Hoffmann
    if (qemu_opt_get_bool(opts, "mux", 0)) {
2534 7591c5c1 Gerd Hoffmann
        CharDriverState *base = chr;
2535 7591c5c1 Gerd Hoffmann
        int len = strlen(qemu_opts_id(opts)) + 6;
2536 7591c5c1 Gerd Hoffmann
        base->label = qemu_malloc(len);
2537 7591c5c1 Gerd Hoffmann
        snprintf(base->label, len, "%s-base", qemu_opts_id(opts));
2538 7591c5c1 Gerd Hoffmann
        chr = qemu_chr_open_mux(base);
2539 7591c5c1 Gerd Hoffmann
        chr->filename = base->filename;
2540 72cf2d4f Blue Swirl
        QTAILQ_INSERT_TAIL(&chardevs, chr, next);
2541 7591c5c1 Gerd Hoffmann
    }
2542 7591c5c1 Gerd Hoffmann
    chr->label = qemu_strdup(qemu_opts_id(opts));
2543 191bc01b Gerd Hoffmann
    return chr;
2544 191bc01b Gerd Hoffmann
}
2545 191bc01b Gerd Hoffmann
2546 ceecf1d1 aurel32
CharDriverState *qemu_chr_open(const char *label, const char *filename, void (*init)(struct CharDriverState *s))
2547 6f97dba0 aliguori
{
2548 6f97dba0 aliguori
    const char *p;
2549 6f97dba0 aliguori
    CharDriverState *chr;
2550 191bc01b Gerd Hoffmann
    QemuOpts *opts;
2551 191bc01b Gerd Hoffmann
2552 c845f401 Gerd Hoffmann
    if (strstart(filename, "chardev:", &p)) {
2553 c845f401 Gerd Hoffmann
        return qemu_chr_find(p);
2554 c845f401 Gerd Hoffmann
    }
2555 c845f401 Gerd Hoffmann
2556 191bc01b Gerd Hoffmann
    opts = qemu_chr_parse_compat(label, filename);
2557 7e1b35b4 Gerd Hoffmann
    if (!opts)
2558 7e1b35b4 Gerd Hoffmann
        return NULL;
2559 6f97dba0 aliguori
2560 7e1b35b4 Gerd Hoffmann
    chr = qemu_chr_open_opts(opts, init);
2561 7e1b35b4 Gerd Hoffmann
    if (chr && qemu_opt_get_bool(opts, "mux", 0)) {
2562 7e1b35b4 Gerd Hoffmann
        monitor_init(chr, MONITOR_USE_READLINE);
2563 6f97dba0 aliguori
    }
2564 6f97dba0 aliguori
    return chr;
2565 6f97dba0 aliguori
}
2566 6f97dba0 aliguori
2567 6f97dba0 aliguori
void qemu_chr_close(CharDriverState *chr)
2568 6f97dba0 aliguori
{
2569 72cf2d4f Blue Swirl
    QTAILQ_REMOVE(&chardevs, chr, next);
2570 6f97dba0 aliguori
    if (chr->chr_close)
2571 6f97dba0 aliguori
        chr->chr_close(chr);
2572 6f97dba0 aliguori
    qemu_free(chr->filename);
2573 6f97dba0 aliguori
    qemu_free(chr->label);
2574 6f97dba0 aliguori
    qemu_free(chr);
2575 6f97dba0 aliguori
}
2576 6f97dba0 aliguori
2577 588b3832 Luiz Capitulino
static void qemu_chr_qlist_iter(QObject *obj, void *opaque)
2578 6f97dba0 aliguori
{
2579 588b3832 Luiz Capitulino
    QDict *chr_dict;
2580 588b3832 Luiz Capitulino
    Monitor *mon = opaque;
2581 588b3832 Luiz Capitulino
2582 588b3832 Luiz Capitulino
    chr_dict = qobject_to_qdict(obj);
2583 588b3832 Luiz Capitulino
    monitor_printf(mon, "%s: filename=%s\n", qdict_get_str(chr_dict, "label"),
2584 588b3832 Luiz Capitulino
                                         qdict_get_str(chr_dict, "filename"));
2585 588b3832 Luiz Capitulino
}
2586 588b3832 Luiz Capitulino
2587 588b3832 Luiz Capitulino
void qemu_chr_info_print(Monitor *mon, const QObject *ret_data)
2588 588b3832 Luiz Capitulino
{
2589 588b3832 Luiz Capitulino
    qlist_iter(qobject_to_qlist(ret_data), qemu_chr_qlist_iter, mon);
2590 588b3832 Luiz Capitulino
}
2591 588b3832 Luiz Capitulino
2592 588b3832 Luiz Capitulino
void qemu_chr_info(Monitor *mon, QObject **ret_data)
2593 588b3832 Luiz Capitulino
{
2594 588b3832 Luiz Capitulino
    QList *chr_list;
2595 6f97dba0 aliguori
    CharDriverState *chr;
2596 6f97dba0 aliguori
2597 588b3832 Luiz Capitulino
    chr_list = qlist_new();
2598 588b3832 Luiz Capitulino
2599 72cf2d4f Blue Swirl
    QTAILQ_FOREACH(chr, &chardevs, next) {
2600 588b3832 Luiz Capitulino
        QObject *obj = qobject_from_jsonf("{ 'label': %s, 'filename': %s }",
2601 588b3832 Luiz Capitulino
                                          chr->label, chr->filename);
2602 588b3832 Luiz Capitulino
        qlist_append_obj(chr_list, obj);
2603 6f97dba0 aliguori
    }
2604 588b3832 Luiz Capitulino
2605 588b3832 Luiz Capitulino
    *ret_data = QOBJECT(chr_list);
2606 6f97dba0 aliguori
}
2607 c845f401 Gerd Hoffmann
2608 c845f401 Gerd Hoffmann
CharDriverState *qemu_chr_find(const char *name)
2609 c845f401 Gerd Hoffmann
{
2610 c845f401 Gerd Hoffmann
    CharDriverState *chr;
2611 c845f401 Gerd Hoffmann
2612 72cf2d4f Blue Swirl
    QTAILQ_FOREACH(chr, &chardevs, next) {
2613 c845f401 Gerd Hoffmann
        if (strcmp(chr->label, name) != 0)
2614 c845f401 Gerd Hoffmann
            continue;
2615 c845f401 Gerd Hoffmann
        return chr;
2616 c845f401 Gerd Hoffmann
    }
2617 c845f401 Gerd Hoffmann
    return NULL;
2618 c845f401 Gerd Hoffmann
}