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