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