blob: 85675802f0ac5a58aac275c92e5b5a20db49091b [file] [log] [blame]
aliguori6f97dba2008-10-31 18:49:55 +00001/*
2 * QEMU System Emulator
3 *
4 * Copyright (c) 2003-2008 Fabrice Bellard
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
12 *
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
15 *
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22 * THE SOFTWARE.
23 */
24#include "qemu-common.h"
Paolo Bonzini83c90892012-12-17 18:19:49 +010025#include "monitor/monitor.h"
Paolo Bonzini9c17d612012-12-17 18:20:04 +010026#include "sysemu/sysemu.h"
Markus Armbrusterd49b6832015-03-17 18:29:20 +010027#include "qemu/error-report.h"
Paolo Bonzini1de7afc2012-12-17 18:20:00 +010028#include "qemu/timer.h"
Paolo Bonzinidccfcd02013-04-08 16:55:25 +020029#include "sysemu/char.h"
aurel32cf3ebac2008-11-01 00:53:09 +000030#include "hw/usb.h"
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -030031#include "qmp-commands.h"
Corey Minyardcfb429c2014-10-02 11:17:35 -050032#include "qapi/qmp-input-visitor.h"
33#include "qapi/qmp-output-visitor.h"
34#include "qapi-visit.h"
aliguori6f97dba2008-10-31 18:49:55 +000035
36#include <unistd.h>
37#include <fcntl.h>
aliguori6f97dba2008-10-31 18:49:55 +000038#include <time.h>
39#include <errno.h>
40#include <sys/time.h>
41#include <zlib.h>
42
43#ifndef _WIN32
44#include <sys/times.h>
45#include <sys/wait.h>
46#include <termios.h>
47#include <sys/mman.h>
48#include <sys/ioctl.h>
blueswir124646c72008-11-07 16:55:48 +000049#include <sys/resource.h>
aliguori6f97dba2008-10-31 18:49:55 +000050#include <sys/socket.h>
51#include <netinet/in.h>
blueswir124646c72008-11-07 16:55:48 +000052#include <net/if.h>
blueswir124646c72008-11-07 16:55:48 +000053#include <arpa/inet.h>
aliguori6f97dba2008-10-31 18:49:55 +000054#include <netdb.h>
55#include <sys/select.h>
Juan Quintela71e72a12009-07-27 16:12:56 +020056#ifdef CONFIG_BSD
aliguori6f97dba2008-10-31 18:49:55 +000057#include <sys/stat.h>
Michael Tokarev3294ce12012-06-02 23:43:33 +040058#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
Aurelien Jarnobbe813a2009-11-30 15:42:59 +010065#else
aliguori6f97dba2008-10-31 18:49:55 +000066#ifdef __linux__
aliguori6f97dba2008-10-31 18:49:55 +000067#include <linux/ppdev.h>
68#include <linux/parport.h>
69#endif
70#ifdef __sun__
71#include <sys/stat.h>
72#include <sys/ethernet.h>
73#include <sys/sockio.h>
74#include <netinet/arp.h>
75#include <netinet/in.h>
76#include <netinet/in_systm.h>
77#include <netinet/ip.h>
78#include <netinet/ip_icmp.h> // must come after ip.h
79#include <netinet/udp.h>
80#include <netinet/tcp.h>
aliguori6f97dba2008-10-31 18:49:55 +000081#endif
82#endif
83#endif
84
Paolo Bonzini1de7afc2012-12-17 18:20:00 +010085#include "qemu/sockets.h"
Alon Levycbcc6332011-01-19 10:49:50 +020086#include "ui/qemu-spice.h"
aliguori6f97dba2008-10-31 18:49:55 +000087
Amit Shah9bd78542009-11-03 19:59:54 +053088#define READ_BUF_LEN 4096
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +030089#define READ_RETRIES 10
Corey Minyard9f781162014-10-02 11:17:33 -050090#define CHR_MAX_FILENAME_SIZE 256
Michael S. Tsirkinc4095722014-11-02 18:48:32 +020091#define TCP_MAX_FDS 16
Amit Shah9bd78542009-11-03 19:59:54 +053092
aliguori6f97dba2008-10-31 18:49:55 +000093/***********************************************************/
Corey Minyardcfb429c2014-10-02 11:17:35 -050094/* Socket address helpers */
95static void qapi_copy_SocketAddress(SocketAddress **p_dest,
96 SocketAddress *src)
97{
98 QmpOutputVisitor *qov;
99 QmpInputVisitor *qiv;
100 Visitor *ov, *iv;
101 QObject *obj;
102
103 *p_dest = NULL;
104
105 qov = qmp_output_visitor_new();
106 ov = qmp_output_get_visitor(qov);
107 visit_type_SocketAddress(ov, &src, NULL, &error_abort);
108 obj = qmp_output_get_qobject(qov);
109 qmp_output_visitor_cleanup(qov);
110 if (!obj) {
111 return;
112 }
113
114 qiv = qmp_input_visitor_new(obj);
115 iv = qmp_input_get_visitor(qiv);
116 visit_type_SocketAddress(iv, p_dest, NULL, &error_abort);
117 qmp_input_visitor_cleanup(qiv);
118 qobject_decref(obj);
119}
120
Corey Minyard16cc4ff2014-10-02 11:17:36 -0500121static int SocketAddress_to_str(char *dest, int max_len,
122 const char *prefix, SocketAddress *addr,
123 bool is_listen, bool is_telnet)
124{
125 switch (addr->kind) {
126 case SOCKET_ADDRESS_KIND_INET:
127 return snprintf(dest, max_len, "%s%s:%s:%s%s", prefix,
128 is_telnet ? "telnet" : "tcp", addr->inet->host,
129 addr->inet->port, is_listen ? ",server" : "");
130 break;
131 case SOCKET_ADDRESS_KIND_UNIX:
132 return snprintf(dest, max_len, "%sunix:%s%s", prefix,
133 addr->q_unix->path, is_listen ? ",server" : "");
134 break;
135 case SOCKET_ADDRESS_KIND_FD:
136 return snprintf(dest, max_len, "%sfd:%s%s", prefix, addr->fd->str,
137 is_listen ? ",server" : "");
138 break;
139 default:
140 abort();
141 }
142}
143
144static int sockaddr_to_str(char *dest, int max_len,
145 struct sockaddr_storage *ss, socklen_t ss_len,
Corey Minyard01ca5192014-10-02 11:17:38 -0500146 struct sockaddr_storage *ps, socklen_t ps_len,
Corey Minyard16cc4ff2014-10-02 11:17:36 -0500147 bool is_listen, bool is_telnet)
148{
Corey Minyard01ca5192014-10-02 11:17:38 -0500149 char shost[NI_MAXHOST], sserv[NI_MAXSERV];
150 char phost[NI_MAXHOST], pserv[NI_MAXSERV];
Corey Minyard16cc4ff2014-10-02 11:17:36 -0500151 const char *left = "", *right = "";
152
153 switch (ss->ss_family) {
154#ifndef _WIN32
155 case AF_UNIX:
156 return snprintf(dest, max_len, "unix:%s%s",
157 ((struct sockaddr_un *)(ss))->sun_path,
158 is_listen ? ",server" : "");
159#endif
160 case AF_INET6:
161 left = "[";
162 right = "]";
163 /* fall through */
164 case AF_INET:
Corey Minyard01ca5192014-10-02 11:17:38 -0500165 getnameinfo((struct sockaddr *) ss, ss_len, shost, sizeof(shost),
166 sserv, sizeof(sserv), NI_NUMERICHOST | NI_NUMERICSERV);
167 getnameinfo((struct sockaddr *) ps, ps_len, phost, sizeof(phost),
168 pserv, sizeof(pserv), NI_NUMERICHOST | NI_NUMERICSERV);
169 return snprintf(dest, max_len, "%s:%s%s%s:%s%s <-> %s%s%s:%s",
Corey Minyard16cc4ff2014-10-02 11:17:36 -0500170 is_telnet ? "telnet" : "tcp",
Corey Minyard01ca5192014-10-02 11:17:38 -0500171 left, shost, right, sserv,
172 is_listen ? ",server" : "",
173 left, phost, right, pserv);
Corey Minyard16cc4ff2014-10-02 11:17:36 -0500174
175 default:
176 return snprintf(dest, max_len, "unknown");
177 }
178}
179
Corey Minyardcfb429c2014-10-02 11:17:35 -0500180/***********************************************************/
aliguori6f97dba2008-10-31 18:49:55 +0000181/* character device */
182
Blue Swirl72cf2d42009-09-12 07:36:22 +0000183static QTAILQ_HEAD(CharDriverStateHead, CharDriverState) chardevs =
184 QTAILQ_HEAD_INITIALIZER(chardevs);
aliguori2970a6c2009-03-05 22:59:58 +0000185
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +0200186CharDriverState *qemu_chr_alloc(void)
187{
188 CharDriverState *chr = g_malloc0(sizeof(CharDriverState));
Paolo Bonzinif3db17b2014-06-25 09:04:57 +0200189 qemu_mutex_init(&chr->chr_write_lock);
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +0200190 return chr;
191}
192
Hans de Goedea425d232011-11-19 10:22:43 +0100193void qemu_chr_be_event(CharDriverState *s, int event)
aliguori6f97dba2008-10-31 18:49:55 +0000194{
Alexander Graf73cdf3f2010-04-01 18:42:39 +0200195 /* Keep track if the char device is open */
196 switch (event) {
197 case CHR_EVENT_OPENED:
Hans de Goede16665b92013-03-26 11:07:53 +0100198 s->be_open = 1;
Alexander Graf73cdf3f2010-04-01 18:42:39 +0200199 break;
200 case CHR_EVENT_CLOSED:
Hans de Goede16665b92013-03-26 11:07:53 +0100201 s->be_open = 0;
Alexander Graf73cdf3f2010-04-01 18:42:39 +0200202 break;
203 }
204
aliguori6f97dba2008-10-31 18:49:55 +0000205 if (!s->chr_event)
206 return;
207 s->chr_event(s->handler_opaque, event);
208}
209
Hans de Goedefee204f2013-03-26 11:07:54 +0100210void qemu_chr_be_generic_open(CharDriverState *s)
aliguori6f97dba2008-10-31 18:49:55 +0000211{
Michael Rothbd5c51e2013-06-07 15:19:53 -0500212 qemu_chr_be_event(s, CHR_EVENT_OPENED);
aliguori6f97dba2008-10-31 18:49:55 +0000213}
214
Anthony Liguori2cc6e0a2011-08-15 11:17:28 -0500215int qemu_chr_fe_write(CharDriverState *s, const uint8_t *buf, int len)
aliguori6f97dba2008-10-31 18:49:55 +0000216{
Paolo Bonzini9005b2a2014-06-18 08:43:58 +0200217 int ret;
218
219 qemu_mutex_lock(&s->chr_write_lock);
220 ret = s->chr_write(s, buf, len);
221 qemu_mutex_unlock(&s->chr_write_lock);
222 return ret;
aliguori6f97dba2008-10-31 18:49:55 +0000223}
224
Anthony Liguoricd187202013-03-26 10:04:17 -0500225int qemu_chr_fe_write_all(CharDriverState *s, const uint8_t *buf, int len)
226{
227 int offset = 0;
Igor Mammedov09313042014-06-25 10:00:41 +0200228 int res = 0;
Anthony Liguoricd187202013-03-26 10:04:17 -0500229
Paolo Bonzini9005b2a2014-06-18 08:43:58 +0200230 qemu_mutex_lock(&s->chr_write_lock);
Anthony Liguoricd187202013-03-26 10:04:17 -0500231 while (offset < len) {
232 do {
233 res = s->chr_write(s, buf + offset, len - offset);
234 if (res == -1 && errno == EAGAIN) {
235 g_usleep(100);
236 }
237 } while (res == -1 && errno == EAGAIN);
238
Paolo Bonzini9005b2a2014-06-18 08:43:58 +0200239 if (res <= 0) {
Anthony Liguoricd187202013-03-26 10:04:17 -0500240 break;
241 }
242
Anthony Liguoricd187202013-03-26 10:04:17 -0500243 offset += res;
244 }
Paolo Bonzini9005b2a2014-06-18 08:43:58 +0200245 qemu_mutex_unlock(&s->chr_write_lock);
Anthony Liguoricd187202013-03-26 10:04:17 -0500246
Paolo Bonzini9005b2a2014-06-18 08:43:58 +0200247 if (res < 0) {
248 return res;
249 }
Anthony Liguoricd187202013-03-26 10:04:17 -0500250 return offset;
251}
252
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +0300253int qemu_chr_fe_read_all(CharDriverState *s, uint8_t *buf, int len)
254{
255 int offset = 0, counter = 10;
256 int res;
257
258 if (!s->chr_sync_read) {
259 return 0;
260 }
261
262 while (offset < len) {
263 do {
264 res = s->chr_sync_read(s, buf + offset, len - offset);
265 if (res == -1 && errno == EAGAIN) {
266 g_usleep(100);
267 }
268 } while (res == -1 && errno == EAGAIN);
269
270 if (res == 0) {
271 break;
272 }
273
274 if (res < 0) {
275 return res;
276 }
277
278 offset += res;
279
280 if (!counter--) {
281 break;
282 }
283 }
284
285 return offset;
286}
287
Anthony Liguori41084f12011-08-15 11:17:34 -0500288int qemu_chr_fe_ioctl(CharDriverState *s, int cmd, void *arg)
aliguori6f97dba2008-10-31 18:49:55 +0000289{
290 if (!s->chr_ioctl)
291 return -ENOTSUP;
292 return s->chr_ioctl(s, cmd, arg);
293}
294
Anthony Liguori909cda12011-08-15 11:17:31 -0500295int qemu_chr_be_can_write(CharDriverState *s)
aliguori6f97dba2008-10-31 18:49:55 +0000296{
297 if (!s->chr_can_read)
298 return 0;
299 return s->chr_can_read(s->handler_opaque);
300}
301
Anthony Liguorifa5efcc2011-08-15 11:17:30 -0500302void qemu_chr_be_write(CharDriverState *s, uint8_t *buf, int len)
aliguori6f97dba2008-10-31 18:49:55 +0000303{
Stefan Weilac310732012-04-19 22:27:14 +0200304 if (s->chr_read) {
305 s->chr_read(s->handler_opaque, buf, len);
306 }
aliguori6f97dba2008-10-31 18:49:55 +0000307}
308
Anthony Liguori74c0d6f2011-08-15 11:17:39 -0500309int qemu_chr_fe_get_msgfd(CharDriverState *s)
Mark McLoughlin7d174052009-07-22 09:11:39 +0100310{
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +0300311 int fd;
Stefan Hajnoczi4f858612014-06-22 10:38:36 +0800312 return (qemu_chr_fe_get_msgfds(s, &fd, 1) == 1) ? fd : -1;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +0300313}
314
315int qemu_chr_fe_get_msgfds(CharDriverState *s, int *fds, int len)
316{
317 return s->get_msgfds ? s->get_msgfds(s, fds, len) : -1;
Mark McLoughlin7d174052009-07-22 09:11:39 +0100318}
319
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +0300320int qemu_chr_fe_set_msgfds(CharDriverState *s, int *fds, int num)
321{
322 return s->set_msgfds ? s->set_msgfds(s, fds, num) : -1;
323}
324
Daniel P. Berrange13661082011-06-23 13:31:42 +0100325int qemu_chr_add_client(CharDriverState *s, int fd)
326{
327 return s->chr_add_client ? s->chr_add_client(s, fd) : -1;
328}
329
aliguori6f97dba2008-10-31 18:49:55 +0000330void qemu_chr_accept_input(CharDriverState *s)
331{
332 if (s->chr_accept_input)
333 s->chr_accept_input(s);
Jan Kiszka98c8ee12012-03-16 13:18:00 +0100334 qemu_notify_event();
aliguori6f97dba2008-10-31 18:49:55 +0000335}
336
Anthony Liguorie7e71b02011-08-15 11:17:29 -0500337void qemu_chr_fe_printf(CharDriverState *s, const char *fmt, ...)
aliguori6f97dba2008-10-31 18:49:55 +0000338{
Amit Shah9bd78542009-11-03 19:59:54 +0530339 char buf[READ_BUF_LEN];
aliguori6f97dba2008-10-31 18:49:55 +0000340 va_list ap;
341 va_start(ap, fmt);
342 vsnprintf(buf, sizeof(buf), fmt, ap);
Anthony Liguori2cc6e0a2011-08-15 11:17:28 -0500343 qemu_chr_fe_write(s, (uint8_t *)buf, strlen(buf));
aliguori6f97dba2008-10-31 18:49:55 +0000344 va_end(ap);
345}
346
Amit Shah386a5a12013-08-28 15:24:05 +0530347static void remove_fd_in_watch(CharDriverState *chr);
348
aliguori6f97dba2008-10-31 18:49:55 +0000349void qemu_chr_add_handlers(CharDriverState *s,
Juan Quintela7b27a762010-03-11 17:55:39 +0100350 IOCanReadHandler *fd_can_read,
aliguori6f97dba2008-10-31 18:49:55 +0000351 IOReadHandler *fd_read,
352 IOEventHandler *fd_event,
353 void *opaque)
354{
Hans de Goede19083222013-03-26 11:07:56 +0100355 int fe_open;
356
Amit Shahda7d9982011-04-25 15:18:22 +0530357 if (!opaque && !fd_can_read && !fd_read && !fd_event) {
Hans de Goede19083222013-03-26 11:07:56 +0100358 fe_open = 0;
Amit Shah386a5a12013-08-28 15:24:05 +0530359 remove_fd_in_watch(s);
Hans de Goede19083222013-03-26 11:07:56 +0100360 } else {
361 fe_open = 1;
Amit Shah2d6c1ef2011-02-10 12:55:20 +0530362 }
aliguori6f97dba2008-10-31 18:49:55 +0000363 s->chr_can_read = fd_can_read;
364 s->chr_read = fd_read;
365 s->chr_event = fd_event;
366 s->handler_opaque = opaque;
Gal Hammerac1b84d2014-02-25 12:12:35 +0200367 if (fe_open && s->chr_update_read_handler)
aliguori6f97dba2008-10-31 18:49:55 +0000368 s->chr_update_read_handler(s);
Alexander Graf73cdf3f2010-04-01 18:42:39 +0200369
Hans de Goede19083222013-03-26 11:07:56 +0100370 if (!s->explicit_fe_open) {
Hans de Goede8e25daa2013-03-26 11:07:57 +0100371 qemu_chr_fe_set_open(s, fe_open);
Hans de Goede19083222013-03-26 11:07:56 +0100372 }
373
Alexander Graf73cdf3f2010-04-01 18:42:39 +0200374 /* We're connecting to an already opened device, so let's make sure we
375 also get the open event */
Hans de Goedea59bcd32013-03-26 11:08:00 +0100376 if (fe_open && s->be_open) {
Hans de Goedefee204f2013-03-26 11:07:54 +0100377 qemu_chr_be_generic_open(s);
Alexander Graf73cdf3f2010-04-01 18:42:39 +0200378 }
aliguori6f97dba2008-10-31 18:49:55 +0000379}
380
381static int null_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
382{
383 return len;
384}
385
Gerd Hoffmann80dca9e2013-02-21 11:41:26 +0100386static CharDriverState *qemu_chr_open_null(void)
aliguori6f97dba2008-10-31 18:49:55 +0000387{
388 CharDriverState *chr;
389
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +0200390 chr = qemu_chr_alloc();
aliguori6f97dba2008-10-31 18:49:55 +0000391 chr->chr_write = null_chr_write;
Michael Rothbd5c51e2013-06-07 15:19:53 -0500392 chr->explicit_be_open = true;
Markus Armbruster1f514702012-02-07 15:09:08 +0100393 return chr;
aliguori6f97dba2008-10-31 18:49:55 +0000394}
395
396/* MUX driver for serial I/O splitting */
aliguori6f97dba2008-10-31 18:49:55 +0000397#define MAX_MUX 4
398#define MUX_BUFFER_SIZE 32 /* Must be a power of 2. */
399#define MUX_BUFFER_MASK (MUX_BUFFER_SIZE - 1)
400typedef struct {
Juan Quintela7b27a762010-03-11 17:55:39 +0100401 IOCanReadHandler *chr_can_read[MAX_MUX];
aliguori6f97dba2008-10-31 18:49:55 +0000402 IOReadHandler *chr_read[MAX_MUX];
403 IOEventHandler *chr_event[MAX_MUX];
404 void *ext_opaque[MAX_MUX];
405 CharDriverState *drv;
Gerd Hoffmann799f1f22009-09-10 10:58:55 +0200406 int focus;
aliguori6f97dba2008-10-31 18:49:55 +0000407 int mux_cnt;
408 int term_got_escape;
409 int max_size;
aliguoria80bf992009-03-05 23:00:02 +0000410 /* Intermediate input buffer allows to catch escape sequences even if the
411 currently active device is not accepting any input - but only until it
412 is full as well. */
413 unsigned char buffer[MAX_MUX][MUX_BUFFER_SIZE];
414 int prod[MAX_MUX];
415 int cons[MAX_MUX];
Jan Kiszka2d229592009-06-15 22:25:30 +0200416 int timestamps;
Paolo Bonzini9005b2a2014-06-18 08:43:58 +0200417
418 /* Protected by the CharDriverState chr_write_lock. */
Jan Kiszka4ab312f2009-06-15 22:25:34 +0200419 int linestart;
Jan Kiszka2d229592009-06-15 22:25:30 +0200420 int64_t timestamps_start;
aliguori6f97dba2008-10-31 18:49:55 +0000421} MuxDriver;
422
423
Paolo Bonzini9005b2a2014-06-18 08:43:58 +0200424/* Called with chr_write_lock held. */
aliguori6f97dba2008-10-31 18:49:55 +0000425static int mux_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
426{
427 MuxDriver *d = chr->opaque;
428 int ret;
Jan Kiszka2d229592009-06-15 22:25:30 +0200429 if (!d->timestamps) {
Paolo Bonzini6975b712014-06-18 08:43:56 +0200430 ret = qemu_chr_fe_write(d->drv, buf, len);
aliguori6f97dba2008-10-31 18:49:55 +0000431 } else {
432 int i;
433
434 ret = 0;
Jan Kiszka4ab312f2009-06-15 22:25:34 +0200435 for (i = 0; i < len; i++) {
436 if (d->linestart) {
aliguori6f97dba2008-10-31 18:49:55 +0000437 char buf1[64];
438 int64_t ti;
439 int secs;
440
Alex Blighbc72ad62013-08-21 16:03:08 +0100441 ti = qemu_clock_get_ms(QEMU_CLOCK_REALTIME);
Jan Kiszka2d229592009-06-15 22:25:30 +0200442 if (d->timestamps_start == -1)
443 d->timestamps_start = ti;
444 ti -= d->timestamps_start;
aliguoria4bb1db2009-01-22 17:15:16 +0000445 secs = ti / 1000;
aliguori6f97dba2008-10-31 18:49:55 +0000446 snprintf(buf1, sizeof(buf1),
447 "[%02d:%02d:%02d.%03d] ",
448 secs / 3600,
449 (secs / 60) % 60,
450 secs % 60,
aliguoria4bb1db2009-01-22 17:15:16 +0000451 (int)(ti % 1000));
Paolo Bonzini6975b712014-06-18 08:43:56 +0200452 qemu_chr_fe_write(d->drv, (uint8_t *)buf1, strlen(buf1));
Jan Kiszka4ab312f2009-06-15 22:25:34 +0200453 d->linestart = 0;
454 }
Paolo Bonzini6975b712014-06-18 08:43:56 +0200455 ret += qemu_chr_fe_write(d->drv, buf+i, 1);
Jan Kiszka4ab312f2009-06-15 22:25:34 +0200456 if (buf[i] == '\n') {
457 d->linestart = 1;
aliguori6f97dba2008-10-31 18:49:55 +0000458 }
459 }
460 }
461 return ret;
462}
463
464static const char * const mux_help[] = {
465 "% h print this help\n\r",
466 "% x exit emulator\n\r",
467 "% s save disk data back to file (if -snapshot)\n\r",
Gonglei86d10322014-11-15 18:06:46 +0800468 "% t toggle console timestamps\n\r",
aliguori6f97dba2008-10-31 18:49:55 +0000469 "% b send break (magic sysrq)\n\r",
470 "% c switch between console and monitor\n\r",
471 "% % sends %\n\r",
472 NULL
473};
474
475int term_escape_char = 0x01; /* ctrl-a is used for escape */
476static void mux_print_help(CharDriverState *chr)
477{
478 int i, j;
479 char ebuf[15] = "Escape-Char";
480 char cbuf[50] = "\n\r";
481
482 if (term_escape_char > 0 && term_escape_char < 26) {
483 snprintf(cbuf, sizeof(cbuf), "\n\r");
484 snprintf(ebuf, sizeof(ebuf), "C-%c", term_escape_char - 1 + 'a');
485 } else {
486 snprintf(cbuf, sizeof(cbuf),
487 "\n\rEscape-Char set to Ascii: 0x%02x\n\r\n\r",
488 term_escape_char);
489 }
Paolo Bonzini6975b712014-06-18 08:43:56 +0200490 qemu_chr_fe_write(chr, (uint8_t *)cbuf, strlen(cbuf));
aliguori6f97dba2008-10-31 18:49:55 +0000491 for (i = 0; mux_help[i] != NULL; i++) {
492 for (j=0; mux_help[i][j] != '\0'; j++) {
493 if (mux_help[i][j] == '%')
Paolo Bonzini6975b712014-06-18 08:43:56 +0200494 qemu_chr_fe_write(chr, (uint8_t *)ebuf, strlen(ebuf));
aliguori6f97dba2008-10-31 18:49:55 +0000495 else
Paolo Bonzini6975b712014-06-18 08:43:56 +0200496 qemu_chr_fe_write(chr, (uint8_t *)&mux_help[i][j], 1);
aliguori6f97dba2008-10-31 18:49:55 +0000497 }
498 }
499}
500
aliguori2724b182009-03-05 23:01:47 +0000501static void mux_chr_send_event(MuxDriver *d, int mux_nr, int event)
502{
503 if (d->chr_event[mux_nr])
504 d->chr_event[mux_nr](d->ext_opaque[mux_nr], event);
505}
506
aliguori6f97dba2008-10-31 18:49:55 +0000507static int mux_proc_byte(CharDriverState *chr, MuxDriver *d, int ch)
508{
509 if (d->term_got_escape) {
510 d->term_got_escape = 0;
511 if (ch == term_escape_char)
512 goto send_char;
513 switch(ch) {
514 case '?':
515 case 'h':
516 mux_print_help(chr);
517 break;
518 case 'x':
519 {
520 const char *term = "QEMU: Terminated\n\r";
Paolo Bonzini6975b712014-06-18 08:43:56 +0200521 qemu_chr_fe_write(chr, (uint8_t *)term, strlen(term));
aliguori6f97dba2008-10-31 18:49:55 +0000522 exit(0);
523 break;
524 }
525 case 's':
Markus Armbruster6ab4b5a2010-06-02 18:55:18 +0200526 bdrv_commit_all();
aliguori6f97dba2008-10-31 18:49:55 +0000527 break;
528 case 'b':
Hans de Goedea425d232011-11-19 10:22:43 +0100529 qemu_chr_be_event(chr, CHR_EVENT_BREAK);
aliguori6f97dba2008-10-31 18:49:55 +0000530 break;
531 case 'c':
532 /* Switch to the next registered device */
Gerd Hoffmann799f1f22009-09-10 10:58:55 +0200533 mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_OUT);
534 d->focus++;
535 if (d->focus >= d->mux_cnt)
536 d->focus = 0;
537 mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_IN);
aliguori6f97dba2008-10-31 18:49:55 +0000538 break;
Jan Kiszka2d229592009-06-15 22:25:30 +0200539 case 't':
540 d->timestamps = !d->timestamps;
541 d->timestamps_start = -1;
Jan Kiszka4ab312f2009-06-15 22:25:34 +0200542 d->linestart = 0;
Jan Kiszka2d229592009-06-15 22:25:30 +0200543 break;
aliguori6f97dba2008-10-31 18:49:55 +0000544 }
545 } else if (ch == term_escape_char) {
546 d->term_got_escape = 1;
547 } else {
548 send_char:
549 return 1;
550 }
551 return 0;
552}
553
554static void mux_chr_accept_input(CharDriverState *chr)
555{
aliguori6f97dba2008-10-31 18:49:55 +0000556 MuxDriver *d = chr->opaque;
Gerd Hoffmann799f1f22009-09-10 10:58:55 +0200557 int m = d->focus;
aliguori6f97dba2008-10-31 18:49:55 +0000558
aliguoria80bf992009-03-05 23:00:02 +0000559 while (d->prod[m] != d->cons[m] &&
aliguori6f97dba2008-10-31 18:49:55 +0000560 d->chr_can_read[m] &&
561 d->chr_can_read[m](d->ext_opaque[m])) {
562 d->chr_read[m](d->ext_opaque[m],
aliguoria80bf992009-03-05 23:00:02 +0000563 &d->buffer[m][d->cons[m]++ & MUX_BUFFER_MASK], 1);
aliguori6f97dba2008-10-31 18:49:55 +0000564 }
565}
566
567static int mux_chr_can_read(void *opaque)
568{
569 CharDriverState *chr = opaque;
570 MuxDriver *d = chr->opaque;
Gerd Hoffmann799f1f22009-09-10 10:58:55 +0200571 int m = d->focus;
aliguori6f97dba2008-10-31 18:49:55 +0000572
aliguoria80bf992009-03-05 23:00:02 +0000573 if ((d->prod[m] - d->cons[m]) < MUX_BUFFER_SIZE)
aliguori6f97dba2008-10-31 18:49:55 +0000574 return 1;
aliguoria80bf992009-03-05 23:00:02 +0000575 if (d->chr_can_read[m])
576 return d->chr_can_read[m](d->ext_opaque[m]);
aliguori6f97dba2008-10-31 18:49:55 +0000577 return 0;
578}
579
580static void mux_chr_read(void *opaque, const uint8_t *buf, int size)
581{
582 CharDriverState *chr = opaque;
583 MuxDriver *d = chr->opaque;
Gerd Hoffmann799f1f22009-09-10 10:58:55 +0200584 int m = d->focus;
aliguori6f97dba2008-10-31 18:49:55 +0000585 int i;
586
587 mux_chr_accept_input (opaque);
588
589 for(i = 0; i < size; i++)
590 if (mux_proc_byte(chr, d, buf[i])) {
aliguoria80bf992009-03-05 23:00:02 +0000591 if (d->prod[m] == d->cons[m] &&
aliguori6f97dba2008-10-31 18:49:55 +0000592 d->chr_can_read[m] &&
593 d->chr_can_read[m](d->ext_opaque[m]))
594 d->chr_read[m](d->ext_opaque[m], &buf[i], 1);
595 else
aliguoria80bf992009-03-05 23:00:02 +0000596 d->buffer[m][d->prod[m]++ & MUX_BUFFER_MASK] = buf[i];
aliguori6f97dba2008-10-31 18:49:55 +0000597 }
598}
599
600static void mux_chr_event(void *opaque, int event)
601{
602 CharDriverState *chr = opaque;
603 MuxDriver *d = chr->opaque;
604 int i;
605
606 /* Send the event to all registered listeners */
607 for (i = 0; i < d->mux_cnt; i++)
aliguori2724b182009-03-05 23:01:47 +0000608 mux_chr_send_event(d, i, event);
aliguori6f97dba2008-10-31 18:49:55 +0000609}
610
611static void mux_chr_update_read_handler(CharDriverState *chr)
612{
613 MuxDriver *d = chr->opaque;
614
615 if (d->mux_cnt >= MAX_MUX) {
616 fprintf(stderr, "Cannot add I/O handlers, MUX array is full\n");
617 return;
618 }
619 d->ext_opaque[d->mux_cnt] = chr->handler_opaque;
620 d->chr_can_read[d->mux_cnt] = chr->chr_can_read;
621 d->chr_read[d->mux_cnt] = chr->chr_read;
622 d->chr_event[d->mux_cnt] = chr->chr_event;
623 /* Fix up the real driver with mux routines */
624 if (d->mux_cnt == 0) {
625 qemu_chr_add_handlers(d->drv, mux_chr_can_read, mux_chr_read,
626 mux_chr_event, chr);
627 }
Gerd Hoffmann799f1f22009-09-10 10:58:55 +0200628 if (d->focus != -1) {
629 mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_OUT);
Gerd Hoffmanna7aec5d2009-09-10 10:58:54 +0200630 }
Gerd Hoffmann799f1f22009-09-10 10:58:55 +0200631 d->focus = d->mux_cnt;
aliguori6f97dba2008-10-31 18:49:55 +0000632 d->mux_cnt++;
Gerd Hoffmann799f1f22009-09-10 10:58:55 +0200633 mux_chr_send_event(d, d->focus, CHR_EVENT_MUX_IN);
aliguori6f97dba2008-10-31 18:49:55 +0000634}
635
Michael Roth7b7ab182013-07-30 13:04:22 -0500636static bool muxes_realized;
637
638/**
639 * Called after processing of default and command-line-specified
640 * chardevs to deliver CHR_EVENT_OPENED events to any FEs attached
641 * to a mux chardev. This is done here to ensure that
642 * output/prompts/banners are only displayed for the FE that has
643 * focus when initial command-line processing/machine init is
644 * completed.
645 *
646 * After this point, any new FE attached to any new or existing
647 * mux will receive CHR_EVENT_OPENED notifications for the BE
648 * immediately.
649 */
650static void muxes_realize_done(Notifier *notifier, void *unused)
651{
652 CharDriverState *chr;
653
654 QTAILQ_FOREACH(chr, &chardevs, next) {
655 if (chr->is_mux) {
656 MuxDriver *d = chr->opaque;
657 int i;
658
659 /* send OPENED to all already-attached FEs */
660 for (i = 0; i < d->mux_cnt; i++) {
661 mux_chr_send_event(d, i, CHR_EVENT_OPENED);
662 }
663 /* mark mux as OPENED so any new FEs will immediately receive
664 * OPENED event
665 */
666 qemu_chr_be_generic_open(chr);
667 }
668 }
669 muxes_realized = true;
670}
671
672static Notifier muxes_realize_notify = {
673 .notify = muxes_realize_done,
674};
675
Kirill Batuzov3f0838a2014-07-04 16:43:15 +0400676static GSource *mux_chr_add_watch(CharDriverState *s, GIOCondition cond)
677{
678 MuxDriver *d = s->opaque;
679 return d->drv->chr_add_watch(d->drv, cond);
680}
681
aliguori6f97dba2008-10-31 18:49:55 +0000682static CharDriverState *qemu_chr_open_mux(CharDriverState *drv)
683{
684 CharDriverState *chr;
685 MuxDriver *d;
686
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +0200687 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +0200688 d = g_new0(MuxDriver, 1);
aliguori6f97dba2008-10-31 18:49:55 +0000689
690 chr->opaque = d;
691 d->drv = drv;
Gerd Hoffmann799f1f22009-09-10 10:58:55 +0200692 d->focus = -1;
aliguori6f97dba2008-10-31 18:49:55 +0000693 chr->chr_write = mux_chr_write;
694 chr->chr_update_read_handler = mux_chr_update_read_handler;
695 chr->chr_accept_input = mux_chr_accept_input;
Hans de Goede7c32c4f2011-03-24 11:12:02 +0100696 /* Frontend guest-open / -close notification is not support with muxes */
Hans de Goede574b7112013-03-26 11:07:58 +0100697 chr->chr_set_fe_open = NULL;
Kirill Batuzov3f0838a2014-07-04 16:43:15 +0400698 if (drv->chr_add_watch) {
699 chr->chr_add_watch = mux_chr_add_watch;
700 }
Michael Roth7b7ab182013-07-30 13:04:22 -0500701 /* only default to opened state if we've realized the initial
702 * set of muxes
703 */
704 chr->explicit_be_open = muxes_realized ? 0 : 1;
705 chr->is_mux = 1;
Alexander Graf73cdf3f2010-04-01 18:42:39 +0200706
aliguori6f97dba2008-10-31 18:49:55 +0000707 return chr;
708}
709
710
711#ifdef _WIN32
aliguorid247d252008-11-11 20:46:40 +0000712int send_all(int fd, const void *buf, int len1)
aliguori6f97dba2008-10-31 18:49:55 +0000713{
714 int ret, len;
715
716 len = len1;
717 while (len > 0) {
718 ret = send(fd, buf, len, 0);
719 if (ret < 0) {
aliguori6f97dba2008-10-31 18:49:55 +0000720 errno = WSAGetLastError();
721 if (errno != WSAEWOULDBLOCK) {
722 return -1;
723 }
724 } else if (ret == 0) {
725 break;
726 } else {
727 buf += ret;
728 len -= ret;
729 }
730 }
731 return len1 - len;
732}
733
734#else
735
Jes Sorensen5fc9cfe2010-11-01 20:02:23 +0100736int send_all(int fd, const void *_buf, int len1)
aliguori6f97dba2008-10-31 18:49:55 +0000737{
738 int ret, len;
Jes Sorensen5fc9cfe2010-11-01 20:02:23 +0100739 const uint8_t *buf = _buf;
aliguori6f97dba2008-10-31 18:49:55 +0000740
741 len = len1;
742 while (len > 0) {
743 ret = write(fd, buf, len);
744 if (ret < 0) {
745 if (errno != EINTR && errno != EAGAIN)
746 return -1;
747 } else if (ret == 0) {
748 break;
749 } else {
750 buf += ret;
751 len -= ret;
752 }
753 }
754 return len1 - len;
755}
Stefan Berger4549a8b2013-02-27 12:47:53 -0500756
757int recv_all(int fd, void *_buf, int len1, bool single_read)
758{
759 int ret, len;
760 uint8_t *buf = _buf;
761
762 len = len1;
763 while ((len > 0) && (ret = read(fd, buf, len)) != 0) {
764 if (ret < 0) {
765 if (errno != EINTR && errno != EAGAIN) {
766 return -1;
767 }
768 continue;
769 } else {
770 if (single_read) {
771 return ret;
772 }
773 buf += ret;
774 len -= ret;
775 }
776 }
777 return len1 - len;
778}
779
aliguori6f97dba2008-10-31 18:49:55 +0000780#endif /* !_WIN32 */
781
Anthony Liguori96c63842013-03-05 23:21:18 +0530782typedef struct IOWatchPoll
783{
Paolo Bonzinid185c092013-04-05 17:59:33 +0200784 GSource parent;
785
Paolo Bonzini1e885b22013-04-08 15:03:15 +0200786 GIOChannel *channel;
Anthony Liguori96c63842013-03-05 23:21:18 +0530787 GSource *src;
Anthony Liguori96c63842013-03-05 23:21:18 +0530788
789 IOCanReadHandler *fd_can_read;
Paolo Bonzini1e885b22013-04-08 15:03:15 +0200790 GSourceFunc fd_read;
Anthony Liguori96c63842013-03-05 23:21:18 +0530791 void *opaque;
Anthony Liguori96c63842013-03-05 23:21:18 +0530792} IOWatchPoll;
793
Anthony Liguori96c63842013-03-05 23:21:18 +0530794static IOWatchPoll *io_watch_poll_from_source(GSource *source)
795{
Paolo Bonzinid185c092013-04-05 17:59:33 +0200796 return container_of(source, IOWatchPoll, parent);
Anthony Liguori96c63842013-03-05 23:21:18 +0530797}
798
799static gboolean io_watch_poll_prepare(GSource *source, gint *timeout_)
800{
801 IOWatchPoll *iwp = io_watch_poll_from_source(source);
Paolo Bonzinid185c092013-04-05 17:59:33 +0200802 bool now_active = iwp->fd_can_read(iwp->opaque) > 0;
Paolo Bonzini1e885b22013-04-08 15:03:15 +0200803 bool was_active = iwp->src != NULL;
Paolo Bonzinid185c092013-04-05 17:59:33 +0200804 if (was_active == now_active) {
Anthony Liguori96c63842013-03-05 23:21:18 +0530805 return FALSE;
806 }
807
Paolo Bonzinid185c092013-04-05 17:59:33 +0200808 if (now_active) {
Nils Carlson4bf1cb02015-07-19 20:39:56 +0000809 iwp->src = g_io_create_watch(iwp->channel,
810 G_IO_IN | G_IO_ERR | G_IO_HUP | G_IO_NVAL);
Paolo Bonzini1e885b22013-04-08 15:03:15 +0200811 g_source_set_callback(iwp->src, iwp->fd_read, iwp->opaque, NULL);
Paolo Bonzinid185c092013-04-05 17:59:33 +0200812 g_source_attach(iwp->src, NULL);
813 } else {
Paolo Bonzini1e885b22013-04-08 15:03:15 +0200814 g_source_destroy(iwp->src);
815 g_source_unref(iwp->src);
816 iwp->src = NULL;
Paolo Bonzinid185c092013-04-05 17:59:33 +0200817 }
818 return FALSE;
Anthony Liguori96c63842013-03-05 23:21:18 +0530819}
820
821static gboolean io_watch_poll_check(GSource *source)
822{
Paolo Bonzinid185c092013-04-05 17:59:33 +0200823 return FALSE;
Anthony Liguori96c63842013-03-05 23:21:18 +0530824}
825
826static gboolean io_watch_poll_dispatch(GSource *source, GSourceFunc callback,
827 gpointer user_data)
828{
Paolo Bonzinid185c092013-04-05 17:59:33 +0200829 abort();
Anthony Liguori96c63842013-03-05 23:21:18 +0530830}
831
832static void io_watch_poll_finalize(GSource *source)
833{
Paolo Bonzini2b316772013-04-19 17:32:09 +0200834 /* Due to a glib bug, removing the last reference to a source
835 * inside a finalize callback causes recursive locking (and a
836 * deadlock). This is not a problem inside other callbacks,
837 * including dispatch callbacks, so we call io_remove_watch_poll
838 * to remove this source. At this point, iwp->src must
839 * be NULL, or we would leak it.
840 *
841 * This would be solved much more elegantly by child sources,
842 * but we support older glib versions that do not have them.
843 */
Anthony Liguori96c63842013-03-05 23:21:18 +0530844 IOWatchPoll *iwp = io_watch_poll_from_source(source);
Paolo Bonzini2b316772013-04-19 17:32:09 +0200845 assert(iwp->src == NULL);
Anthony Liguori96c63842013-03-05 23:21:18 +0530846}
847
848static GSourceFuncs io_watch_poll_funcs = {
849 .prepare = io_watch_poll_prepare,
850 .check = io_watch_poll_check,
851 .dispatch = io_watch_poll_dispatch,
852 .finalize = io_watch_poll_finalize,
853};
854
855/* Can only be used for read */
856static guint io_add_watch_poll(GIOChannel *channel,
857 IOCanReadHandler *fd_can_read,
858 GIOFunc fd_read,
859 gpointer user_data)
860{
861 IOWatchPoll *iwp;
Paolo Bonzini0ca5aa42013-04-10 15:23:27 +0200862 int tag;
Anthony Liguori96c63842013-03-05 23:21:18 +0530863
Paolo Bonzinid185c092013-04-05 17:59:33 +0200864 iwp = (IOWatchPoll *) g_source_new(&io_watch_poll_funcs, sizeof(IOWatchPoll));
Anthony Liguori96c63842013-03-05 23:21:18 +0530865 iwp->fd_can_read = fd_can_read;
866 iwp->opaque = user_data;
Paolo Bonzini1e885b22013-04-08 15:03:15 +0200867 iwp->channel = channel;
868 iwp->fd_read = (GSourceFunc) fd_read;
869 iwp->src = NULL;
Anthony Liguori96c63842013-03-05 23:21:18 +0530870
Paolo Bonzini0ca5aa42013-04-10 15:23:27 +0200871 tag = g_source_attach(&iwp->parent, NULL);
872 g_source_unref(&iwp->parent);
873 return tag;
Anthony Liguori96c63842013-03-05 23:21:18 +0530874}
875
Paolo Bonzini2b316772013-04-19 17:32:09 +0200876static void io_remove_watch_poll(guint tag)
877{
878 GSource *source;
879 IOWatchPoll *iwp;
880
881 g_return_if_fail (tag > 0);
882
883 source = g_main_context_find_source_by_id(NULL, tag);
884 g_return_if_fail (source != NULL);
885
886 iwp = io_watch_poll_from_source(source);
887 if (iwp->src) {
888 g_source_destroy(iwp->src);
889 g_source_unref(iwp->src);
890 iwp->src = NULL;
891 }
892 g_source_destroy(&iwp->parent);
893}
894
Amit Shah26da70c2013-08-28 15:23:37 +0530895static void remove_fd_in_watch(CharDriverState *chr)
896{
897 if (chr->fd_in_tag) {
898 io_remove_watch_poll(chr->fd_in_tag);
899 chr->fd_in_tag = 0;
900 }
901}
902
Blue Swirl44ab9ed2013-03-09 09:56:04 +0000903#ifndef _WIN32
Anthony Liguori96c63842013-03-05 23:21:18 +0530904static GIOChannel *io_channel_from_fd(int fd)
905{
906 GIOChannel *chan;
907
908 if (fd == -1) {
909 return NULL;
910 }
911
912 chan = g_io_channel_unix_new(fd);
913
914 g_io_channel_set_encoding(chan, NULL, NULL);
915 g_io_channel_set_buffered(chan, FALSE);
916
917 return chan;
918}
Blue Swirl44ab9ed2013-03-09 09:56:04 +0000919#endif
Anthony Liguori96c63842013-03-05 23:21:18 +0530920
Anthony Liguori76a96442013-03-05 23:21:21 +0530921static GIOChannel *io_channel_from_socket(int fd)
922{
923 GIOChannel *chan;
924
925 if (fd == -1) {
926 return NULL;
927 }
928
929#ifdef _WIN32
930 chan = g_io_channel_win32_new_socket(fd);
931#else
932 chan = g_io_channel_unix_new(fd);
933#endif
934
935 g_io_channel_set_encoding(chan, NULL, NULL);
936 g_io_channel_set_buffered(chan, FALSE);
937
938 return chan;
939}
940
Anthony Liguori684a0962013-03-29 11:39:50 -0500941static int io_channel_send(GIOChannel *fd, const void *buf, size_t len)
Anthony Liguori96c63842013-03-05 23:21:18 +0530942{
Laszlo Ersekac8c26f2013-07-16 20:19:40 +0200943 size_t offset = 0;
944 GIOStatus status = G_IO_STATUS_NORMAL;
Anthony Liguori96c63842013-03-05 23:21:18 +0530945
Laszlo Ersekac8c26f2013-07-16 20:19:40 +0200946 while (offset < len && status == G_IO_STATUS_NORMAL) {
947 gsize bytes_written = 0;
Anthony Liguori684a0962013-03-29 11:39:50 -0500948
949 status = g_io_channel_write_chars(fd, buf + offset, len - offset,
Anthony Liguori96c63842013-03-05 23:21:18 +0530950 &bytes_written, NULL);
Anthony Liguori684a0962013-03-29 11:39:50 -0500951 offset += bytes_written;
Anthony Liguori96c63842013-03-05 23:21:18 +0530952 }
Anthony Liguori684a0962013-03-29 11:39:50 -0500953
Laszlo Ersekac8c26f2013-07-16 20:19:40 +0200954 if (offset > 0) {
955 return offset;
956 }
957 switch (status) {
958 case G_IO_STATUS_NORMAL:
959 g_assert(len == 0);
960 return 0;
961 case G_IO_STATUS_AGAIN:
962 errno = EAGAIN;
963 return -1;
964 default:
965 break;
966 }
967 errno = EINVAL;
968 return -1;
Anthony Liguori96c63842013-03-05 23:21:18 +0530969}
Anthony Liguori96c63842013-03-05 23:21:18 +0530970
Blue Swirl44ab9ed2013-03-09 09:56:04 +0000971#ifndef _WIN32
972
Anthony Liguoria29753f2013-03-05 23:21:19 +0530973typedef struct FDCharDriver {
974 CharDriverState *chr;
975 GIOChannel *fd_in, *fd_out;
aliguori6f97dba2008-10-31 18:49:55 +0000976 int max_size;
977} FDCharDriver;
978
Paolo Bonzini9005b2a2014-06-18 08:43:58 +0200979/* Called with chr_write_lock held. */
aliguori6f97dba2008-10-31 18:49:55 +0000980static int fd_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
981{
982 FDCharDriver *s = chr->opaque;
Anthony Liguoria29753f2013-03-05 23:21:19 +0530983
Anthony Liguori684a0962013-03-29 11:39:50 -0500984 return io_channel_send(s->fd_out, buf, len);
Anthony Liguoria29753f2013-03-05 23:21:19 +0530985}
986
987static gboolean fd_chr_read(GIOChannel *chan, GIOCondition cond, void *opaque)
988{
989 CharDriverState *chr = opaque;
990 FDCharDriver *s = chr->opaque;
991 int len;
992 uint8_t buf[READ_BUF_LEN];
993 GIOStatus status;
994 gsize bytes_read;
995
996 len = sizeof(buf);
997 if (len > s->max_size) {
998 len = s->max_size;
999 }
1000 if (len == 0) {
Paolo Bonzinicdbf6e12013-04-19 17:32:08 +02001001 return TRUE;
Anthony Liguoria29753f2013-03-05 23:21:19 +05301002 }
1003
1004 status = g_io_channel_read_chars(chan, (gchar *)buf,
1005 len, &bytes_read, NULL);
1006 if (status == G_IO_STATUS_EOF) {
Amit Shah26da70c2013-08-28 15:23:37 +05301007 remove_fd_in_watch(chr);
Anthony Liguoria29753f2013-03-05 23:21:19 +05301008 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
1009 return FALSE;
1010 }
1011 if (status == G_IO_STATUS_NORMAL) {
1012 qemu_chr_be_write(chr, buf, bytes_read);
1013 }
1014
1015 return TRUE;
aliguori6f97dba2008-10-31 18:49:55 +00001016}
1017
1018static int fd_chr_read_poll(void *opaque)
1019{
1020 CharDriverState *chr = opaque;
1021 FDCharDriver *s = chr->opaque;
1022
Anthony Liguori909cda12011-08-15 11:17:31 -05001023 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00001024 return s->max_size;
1025}
1026
Anthony Liguori23673ca2013-03-05 23:21:23 +05301027static GSource *fd_chr_add_watch(CharDriverState *chr, GIOCondition cond)
1028{
1029 FDCharDriver *s = chr->opaque;
1030 return g_io_create_watch(s->fd_out, cond);
1031}
1032
aliguori6f97dba2008-10-31 18:49:55 +00001033static void fd_chr_update_read_handler(CharDriverState *chr)
1034{
1035 FDCharDriver *s = chr->opaque;
1036
Amit Shah26da70c2013-08-28 15:23:37 +05301037 remove_fd_in_watch(chr);
Anthony Liguoria29753f2013-03-05 23:21:19 +05301038 if (s->fd_in) {
Amit Shah7ba9add2013-08-28 15:18:29 +05301039 chr->fd_in_tag = io_add_watch_poll(s->fd_in, fd_chr_read_poll,
1040 fd_chr_read, chr);
aliguori6f97dba2008-10-31 18:49:55 +00001041 }
1042}
1043
1044static void fd_chr_close(struct CharDriverState *chr)
1045{
1046 FDCharDriver *s = chr->opaque;
1047
Amit Shah26da70c2013-08-28 15:23:37 +05301048 remove_fd_in_watch(chr);
Anthony Liguoria29753f2013-03-05 23:21:19 +05301049 if (s->fd_in) {
1050 g_io_channel_unref(s->fd_in);
1051 }
1052 if (s->fd_out) {
1053 g_io_channel_unref(s->fd_out);
aliguori6f97dba2008-10-31 18:49:55 +00001054 }
1055
Anthony Liguori7267c092011-08-20 22:09:37 -05001056 g_free(s);
Hans de Goedea425d232011-11-19 10:22:43 +01001057 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
aliguori6f97dba2008-10-31 18:49:55 +00001058}
1059
1060/* open a character device to a unix fd */
1061static CharDriverState *qemu_chr_open_fd(int fd_in, int fd_out)
1062{
1063 CharDriverState *chr;
1064 FDCharDriver *s;
1065
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02001066 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02001067 s = g_new0(FDCharDriver, 1);
Anthony Liguoria29753f2013-03-05 23:21:19 +05301068 s->fd_in = io_channel_from_fd(fd_in);
1069 s->fd_out = io_channel_from_fd(fd_out);
Gonglei4ff12bd2014-08-11 17:34:20 +08001070 qemu_set_nonblock(fd_out);
Anthony Liguoria29753f2013-03-05 23:21:19 +05301071 s->chr = chr;
aliguori6f97dba2008-10-31 18:49:55 +00001072 chr->opaque = s;
Anthony Liguori23673ca2013-03-05 23:21:23 +05301073 chr->chr_add_watch = fd_chr_add_watch;
aliguori6f97dba2008-10-31 18:49:55 +00001074 chr->chr_write = fd_chr_write;
1075 chr->chr_update_read_handler = fd_chr_update_read_handler;
1076 chr->chr_close = fd_chr_close;
1077
aliguori6f97dba2008-10-31 18:49:55 +00001078 return chr;
1079}
1080
Gerd Hoffmann548cbb32013-02-25 11:50:55 +01001081static CharDriverState *qemu_chr_open_pipe(ChardevHostdev *opts)
aliguori6f97dba2008-10-31 18:49:55 +00001082{
1083 int fd_in, fd_out;
Corey Minyard9f781162014-10-02 11:17:33 -05001084 char filename_in[CHR_MAX_FILENAME_SIZE];
1085 char filename_out[CHR_MAX_FILENAME_SIZE];
Gerd Hoffmann548cbb32013-02-25 11:50:55 +01001086 const char *filename = opts->device;
Gerd Hoffmann7d315442009-09-10 10:58:36 +02001087
1088 if (filename == NULL) {
1089 fprintf(stderr, "chardev: pipe: no filename given\n");
Markus Armbruster1f514702012-02-07 15:09:08 +01001090 return NULL;
Gerd Hoffmann7d315442009-09-10 10:58:36 +02001091 }
aliguori6f97dba2008-10-31 18:49:55 +00001092
Corey Minyard9f781162014-10-02 11:17:33 -05001093 snprintf(filename_in, CHR_MAX_FILENAME_SIZE, "%s.in", filename);
1094 snprintf(filename_out, CHR_MAX_FILENAME_SIZE, "%s.out", filename);
Kevin Wolf40ff6d72009-12-02 12:24:42 +01001095 TFR(fd_in = qemu_open(filename_in, O_RDWR | O_BINARY));
1096 TFR(fd_out = qemu_open(filename_out, O_RDWR | O_BINARY));
aliguori6f97dba2008-10-31 18:49:55 +00001097 if (fd_in < 0 || fd_out < 0) {
1098 if (fd_in >= 0)
1099 close(fd_in);
1100 if (fd_out >= 0)
1101 close(fd_out);
Markus Armbrusterb181e042012-02-07 15:09:09 +01001102 TFR(fd_in = fd_out = qemu_open(filename, O_RDWR | O_BINARY));
Markus Armbrustera89dd6c2012-02-07 15:09:10 +01001103 if (fd_in < 0) {
Markus Armbruster1f514702012-02-07 15:09:08 +01001104 return NULL;
Markus Armbrustera89dd6c2012-02-07 15:09:10 +01001105 }
aliguori6f97dba2008-10-31 18:49:55 +00001106 }
Markus Armbruster1f514702012-02-07 15:09:08 +01001107 return qemu_chr_open_fd(fd_in, fd_out);
aliguori6f97dba2008-10-31 18:49:55 +00001108}
1109
aliguori6f97dba2008-10-31 18:49:55 +00001110/* init terminal so that we can grab keys */
1111static struct termios oldtty;
1112static int old_fd0_flags;
Li Liuc88930a2014-09-09 19:19:48 +08001113static bool stdio_in_use;
Paolo Bonzinibb002512010-12-23 13:42:50 +01001114static bool stdio_allow_signal;
Gal Hammere76d4422015-01-07 10:38:35 +02001115static bool stdio_echo_state;
1116
1117static void qemu_chr_set_echo_stdio(CharDriverState *chr, bool echo);
aliguori6f97dba2008-10-31 18:49:55 +00001118
1119static void term_exit(void)
1120{
1121 tcsetattr (0, TCSANOW, &oldtty);
1122 fcntl(0, F_SETFL, old_fd0_flags);
1123}
1124
Gal Hammere76d4422015-01-07 10:38:35 +02001125static void term_stdio_handler(int sig)
1126{
1127 /* restore echo after resume from suspend. */
1128 qemu_chr_set_echo_stdio(NULL, stdio_echo_state);
1129}
1130
Paolo Bonzinibb002512010-12-23 13:42:50 +01001131static void qemu_chr_set_echo_stdio(CharDriverState *chr, bool echo)
aliguori6f97dba2008-10-31 18:49:55 +00001132{
1133 struct termios tty;
1134
Gal Hammere76d4422015-01-07 10:38:35 +02001135 stdio_echo_state = echo;
Paolo Bonzini03693642010-12-23 13:42:49 +01001136 tty = oldtty;
Paolo Bonzinibb002512010-12-23 13:42:50 +01001137 if (!echo) {
1138 tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
aliguori6f97dba2008-10-31 18:49:55 +00001139 |INLCR|IGNCR|ICRNL|IXON);
Paolo Bonzinibb002512010-12-23 13:42:50 +01001140 tty.c_oflag |= OPOST;
1141 tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN);
1142 tty.c_cflag &= ~(CSIZE|PARENB);
1143 tty.c_cflag |= CS8;
1144 tty.c_cc[VMIN] = 1;
1145 tty.c_cc[VTIME] = 0;
1146 }
Paolo Bonzinibb002512010-12-23 13:42:50 +01001147 if (!stdio_allow_signal)
aliguori6f97dba2008-10-31 18:49:55 +00001148 tty.c_lflag &= ~ISIG;
aliguori6f97dba2008-10-31 18:49:55 +00001149
1150 tcsetattr (0, TCSANOW, &tty);
aliguori6f97dba2008-10-31 18:49:55 +00001151}
1152
1153static void qemu_chr_close_stdio(struct CharDriverState *chr)
1154{
1155 term_exit();
aliguori6f97dba2008-10-31 18:49:55 +00001156 fd_chr_close(chr);
1157}
1158
Gerd Hoffmann7c358032013-02-21 12:34:58 +01001159static CharDriverState *qemu_chr_open_stdio(ChardevStdio *opts)
aliguori6f97dba2008-10-31 18:49:55 +00001160{
1161 CharDriverState *chr;
Gal Hammere76d4422015-01-07 10:38:35 +02001162 struct sigaction act;
aliguori6f97dba2008-10-31 18:49:55 +00001163
Michael Tokarevab51b1d2012-12-30 12:48:14 +04001164 if (is_daemonized()) {
1165 error_report("cannot use stdio with -daemonize");
1166 return NULL;
1167 }
Li Liuc88930a2014-09-09 19:19:48 +08001168
1169 if (stdio_in_use) {
1170 error_report("cannot use stdio by multiple character devices");
1171 exit(1);
1172 }
1173
1174 stdio_in_use = true;
Anthony Liguoried7a1542013-03-05 23:21:17 +05301175 old_fd0_flags = fcntl(0, F_GETFL);
Li Liuc88930a2014-09-09 19:19:48 +08001176 tcgetattr(0, &oldtty);
Gonglei4ff12bd2014-08-11 17:34:20 +08001177 qemu_set_nonblock(0);
Anthony Liguoried7a1542013-03-05 23:21:17 +05301178 atexit(term_exit);
Paolo Bonzini03693642010-12-23 13:42:49 +01001179
Gal Hammere76d4422015-01-07 10:38:35 +02001180 memset(&act, 0, sizeof(act));
1181 act.sa_handler = term_stdio_handler;
1182 sigaction(SIGCONT, &act, NULL);
1183
aliguori6f97dba2008-10-31 18:49:55 +00001184 chr = qemu_chr_open_fd(0, 1);
1185 chr->chr_close = qemu_chr_close_stdio;
Paolo Bonzinibb002512010-12-23 13:42:50 +01001186 chr->chr_set_echo = qemu_chr_set_echo_stdio;
Gerd Hoffmann7c358032013-02-21 12:34:58 +01001187 if (opts->has_signal) {
1188 stdio_allow_signal = opts->signal;
1189 }
Anthony Liguori15f31512011-08-15 11:17:35 -05001190 qemu_chr_fe_set_echo(chr, false);
aliguori6f97dba2008-10-31 18:49:55 +00001191
Markus Armbruster1f514702012-02-07 15:09:08 +01001192 return chr;
aliguori6f97dba2008-10-31 18:49:55 +00001193}
1194
aliguori6f97dba2008-10-31 18:49:55 +00001195#if defined(__linux__) || defined(__sun__) || defined(__FreeBSD__) \
Aurelien Jarnoa167ba52009-11-29 18:00:41 +01001196 || defined(__NetBSD__) || defined(__OpenBSD__) || defined(__DragonFly__) \
1197 || defined(__GLIBC__)
aliguori6f97dba2008-10-31 18:49:55 +00001198
Paolo Bonzinid809ab92015-10-12 09:46:23 +02001199#define HAVE_CHARDEV_SERIAL 1
1200#define HAVE_CHARDEV_PTY 1
Gerd Hoffmanne5514982012-12-19 16:35:42 +01001201
aliguori6f97dba2008-10-31 18:49:55 +00001202typedef struct {
Anthony Liguori093d3a22013-03-05 23:21:20 +05301203 GIOChannel *fd;
aliguori6f97dba2008-10-31 18:49:55 +00001204 int read_bytes;
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001205
1206 /* Protected by the CharDriverState chr_write_lock. */
1207 int connected;
Anthony Liguori8aa33ca2013-03-05 23:21:26 +05301208 guint timer_tag;
Paolo Bonzini7b3621f2014-07-11 12:11:38 +02001209 guint open_tag;
aliguori6f97dba2008-10-31 18:49:55 +00001210} PtyCharDriver;
1211
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001212static void pty_chr_update_read_handler_locked(CharDriverState *chr);
aliguori6f97dba2008-10-31 18:49:55 +00001213static void pty_chr_state(CharDriverState *chr, int connected);
1214
Anthony Liguori8aa33ca2013-03-05 23:21:26 +05301215static gboolean pty_chr_timer(gpointer opaque)
1216{
1217 struct CharDriverState *chr = opaque;
1218 PtyCharDriver *s = chr->opaque;
1219
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001220 qemu_mutex_lock(&chr->chr_write_lock);
Hans de Goede79f20072013-04-25 13:53:02 +02001221 s->timer_tag = 0;
Paolo Bonzini7b3621f2014-07-11 12:11:38 +02001222 s->open_tag = 0;
Gerd Hoffmannb0d768c2013-08-22 11:43:58 +02001223 if (!s->connected) {
1224 /* Next poll ... */
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001225 pty_chr_update_read_handler_locked(chr);
Gerd Hoffmannb0d768c2013-08-22 11:43:58 +02001226 }
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001227 qemu_mutex_unlock(&chr->chr_write_lock);
Anthony Liguori8aa33ca2013-03-05 23:21:26 +05301228 return FALSE;
1229}
1230
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001231/* Called with chr_write_lock held. */
Anthony Liguori8aa33ca2013-03-05 23:21:26 +05301232static void pty_chr_rearm_timer(CharDriverState *chr, int ms)
1233{
1234 PtyCharDriver *s = chr->opaque;
1235
1236 if (s->timer_tag) {
1237 g_source_remove(s->timer_tag);
1238 s->timer_tag = 0;
1239 }
1240
1241 if (ms == 1000) {
1242 s->timer_tag = g_timeout_add_seconds(1, pty_chr_timer, chr);
1243 } else {
1244 s->timer_tag = g_timeout_add(ms, pty_chr_timer, chr);
1245 }
1246}
1247
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001248/* Called with chr_write_lock held. */
1249static void pty_chr_update_read_handler_locked(CharDriverState *chr)
Paolo Bonzini1bb7fe72014-06-18 08:43:57 +02001250{
1251 PtyCharDriver *s = chr->opaque;
1252 GPollFD pfd;
1253
1254 pfd.fd = g_io_channel_unix_get_fd(s->fd);
1255 pfd.events = G_IO_OUT;
1256 pfd.revents = 0;
1257 g_poll(&pfd, 1, 0);
1258 if (pfd.revents & G_IO_HUP) {
1259 pty_chr_state(chr, 0);
1260 } else {
1261 pty_chr_state(chr, 1);
1262 }
1263}
1264
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001265static void pty_chr_update_read_handler(CharDriverState *chr)
1266{
1267 qemu_mutex_lock(&chr->chr_write_lock);
1268 pty_chr_update_read_handler_locked(chr);
1269 qemu_mutex_unlock(&chr->chr_write_lock);
1270}
1271
1272/* Called with chr_write_lock held. */
aliguori6f97dba2008-10-31 18:49:55 +00001273static int pty_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
1274{
1275 PtyCharDriver *s = chr->opaque;
1276
1277 if (!s->connected) {
1278 /* guest sends data, check for (re-)connect */
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001279 pty_chr_update_read_handler_locked(chr);
Sebastian Tanasecf7330c2014-07-28 13:39:14 +02001280 if (!s->connected) {
1281 return 0;
1282 }
aliguori6f97dba2008-10-31 18:49:55 +00001283 }
Anthony Liguori684a0962013-03-29 11:39:50 -05001284 return io_channel_send(s->fd, buf, len);
aliguori6f97dba2008-10-31 18:49:55 +00001285}
1286
Anthony Liguorie6a87ed2013-03-05 23:21:24 +05301287static GSource *pty_chr_add_watch(CharDriverState *chr, GIOCondition cond)
1288{
1289 PtyCharDriver *s = chr->opaque;
Paolo Bonzini62c339c2014-07-24 16:08:04 +02001290 if (!s->connected) {
1291 return NULL;
1292 }
Anthony Liguorie6a87ed2013-03-05 23:21:24 +05301293 return g_io_create_watch(s->fd, cond);
1294}
1295
aliguori6f97dba2008-10-31 18:49:55 +00001296static int pty_chr_read_poll(void *opaque)
1297{
1298 CharDriverState *chr = opaque;
1299 PtyCharDriver *s = chr->opaque;
1300
Anthony Liguori909cda12011-08-15 11:17:31 -05001301 s->read_bytes = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00001302 return s->read_bytes;
1303}
1304
Anthony Liguori093d3a22013-03-05 23:21:20 +05301305static gboolean pty_chr_read(GIOChannel *chan, GIOCondition cond, void *opaque)
aliguori6f97dba2008-10-31 18:49:55 +00001306{
1307 CharDriverState *chr = opaque;
1308 PtyCharDriver *s = chr->opaque;
Anthony Liguori093d3a22013-03-05 23:21:20 +05301309 gsize size, len;
Amit Shah9bd78542009-11-03 19:59:54 +05301310 uint8_t buf[READ_BUF_LEN];
Anthony Liguori093d3a22013-03-05 23:21:20 +05301311 GIOStatus status;
aliguori6f97dba2008-10-31 18:49:55 +00001312
1313 len = sizeof(buf);
1314 if (len > s->read_bytes)
1315 len = s->read_bytes;
Paolo Bonzinicdbf6e12013-04-19 17:32:08 +02001316 if (len == 0) {
1317 return TRUE;
1318 }
Anthony Liguori093d3a22013-03-05 23:21:20 +05301319 status = g_io_channel_read_chars(s->fd, (gchar *)buf, len, &size, NULL);
1320 if (status != G_IO_STATUS_NORMAL) {
aliguori6f97dba2008-10-31 18:49:55 +00001321 pty_chr_state(chr, 0);
Anthony Liguori093d3a22013-03-05 23:21:20 +05301322 return FALSE;
1323 } else {
aliguori6f97dba2008-10-31 18:49:55 +00001324 pty_chr_state(chr, 1);
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05001325 qemu_chr_be_write(chr, buf, size);
aliguori6f97dba2008-10-31 18:49:55 +00001326 }
Anthony Liguori093d3a22013-03-05 23:21:20 +05301327 return TRUE;
aliguori6f97dba2008-10-31 18:49:55 +00001328}
1329
Paolo Bonzini7b3621f2014-07-11 12:11:38 +02001330static gboolean qemu_chr_be_generic_open_func(gpointer opaque)
1331{
1332 CharDriverState *chr = opaque;
1333 PtyCharDriver *s = chr->opaque;
1334
1335 s->open_tag = 0;
1336 qemu_chr_be_generic_open(chr);
1337 return FALSE;
1338}
1339
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001340/* Called with chr_write_lock held. */
aliguori6f97dba2008-10-31 18:49:55 +00001341static void pty_chr_state(CharDriverState *chr, int connected)
1342{
1343 PtyCharDriver *s = chr->opaque;
1344
1345 if (!connected) {
Paolo Bonzini7b3621f2014-07-11 12:11:38 +02001346 if (s->open_tag) {
1347 g_source_remove(s->open_tag);
1348 s->open_tag = 0;
1349 }
Amit Shah26da70c2013-08-28 15:23:37 +05301350 remove_fd_in_watch(chr);
aliguori6f97dba2008-10-31 18:49:55 +00001351 s->connected = 0;
aliguori6f97dba2008-10-31 18:49:55 +00001352 /* (re-)connect poll interval for idle guests: once per second.
1353 * We check more frequently in case the guests sends data to
1354 * the virtual device linked to our pty. */
Anthony Liguori8aa33ca2013-03-05 23:21:26 +05301355 pty_chr_rearm_timer(chr, 1000);
aliguori6f97dba2008-10-31 18:49:55 +00001356 } else {
Paolo Bonzini85a67692013-04-19 17:32:07 +02001357 if (s->timer_tag) {
1358 g_source_remove(s->timer_tag);
1359 s->timer_tag = 0;
1360 }
1361 if (!s->connected) {
Paolo Bonzini7b3621f2014-07-11 12:11:38 +02001362 g_assert(s->open_tag == 0);
Paolo Bonzini85a67692013-04-19 17:32:07 +02001363 s->connected = 1;
Paolo Bonzini7b3621f2014-07-11 12:11:38 +02001364 s->open_tag = g_idle_add(qemu_chr_be_generic_open_func, chr);
Gal Hammerac1b84d2014-02-25 12:12:35 +02001365 }
1366 if (!chr->fd_in_tag) {
Amit Shah7ba9add2013-08-28 15:18:29 +05301367 chr->fd_in_tag = io_add_watch_poll(s->fd, pty_chr_read_poll,
1368 pty_chr_read, chr);
Paolo Bonzini85a67692013-04-19 17:32:07 +02001369 }
aliguori6f97dba2008-10-31 18:49:55 +00001370 }
1371}
1372
aliguori6f97dba2008-10-31 18:49:55 +00001373static void pty_chr_close(struct CharDriverState *chr)
1374{
1375 PtyCharDriver *s = chr->opaque;
Anthony Liguori093d3a22013-03-05 23:21:20 +05301376 int fd;
aliguori6f97dba2008-10-31 18:49:55 +00001377
Paolo Bonzini7b3621f2014-07-11 12:11:38 +02001378 qemu_mutex_lock(&chr->chr_write_lock);
1379 pty_chr_state(chr, 0);
Anthony Liguori093d3a22013-03-05 23:21:20 +05301380 fd = g_io_channel_unix_get_fd(s->fd);
1381 g_io_channel_unref(s->fd);
1382 close(fd);
Anthony Liguori8aa33ca2013-03-05 23:21:26 +05301383 if (s->timer_tag) {
1384 g_source_remove(s->timer_tag);
Paolo Bonzini910b6362013-04-19 17:32:06 +02001385 s->timer_tag = 0;
Anthony Liguori8aa33ca2013-03-05 23:21:26 +05301386 }
Paolo Bonzini7b3621f2014-07-11 12:11:38 +02001387 qemu_mutex_unlock(&chr->chr_write_lock);
Anthony Liguori7267c092011-08-20 22:09:37 -05001388 g_free(s);
Hans de Goedea425d232011-11-19 10:22:43 +01001389 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
aliguori6f97dba2008-10-31 18:49:55 +00001390}
1391
Gerd Hoffmanne68c5952013-02-25 10:16:46 +01001392static CharDriverState *qemu_chr_open_pty(const char *id,
1393 ChardevReturn *ret)
aliguori6f97dba2008-10-31 18:49:55 +00001394{
1395 CharDriverState *chr;
1396 PtyCharDriver *s;
Gerd Hoffmanne68c5952013-02-25 10:16:46 +01001397 int master_fd, slave_fd;
aliguori6f97dba2008-10-31 18:49:55 +00001398 char pty_name[PATH_MAX];
aliguori6f97dba2008-10-31 18:49:55 +00001399
Michael Tokarev4efeabb2013-06-05 18:44:54 +04001400 master_fd = qemu_openpty_raw(&slave_fd, pty_name);
1401 if (master_fd < 0) {
Markus Armbruster1f514702012-02-07 15:09:08 +01001402 return NULL;
aliguori6f97dba2008-10-31 18:49:55 +00001403 }
1404
aliguori6f97dba2008-10-31 18:49:55 +00001405 close(slave_fd);
Don Slutzfac66882014-12-22 10:04:00 -05001406 qemu_set_nonblock(master_fd);
aliguori6f97dba2008-10-31 18:49:55 +00001407
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02001408 chr = qemu_chr_alloc();
aliguori6f97dba2008-10-31 18:49:55 +00001409
Michael Tokarev4efeabb2013-06-05 18:44:54 +04001410 chr->filename = g_strdup_printf("pty:%s", pty_name);
1411 ret->pty = g_strdup(pty_name);
Gerd Hoffmanne68c5952013-02-25 10:16:46 +01001412 ret->has_pty = true;
Lei Li58650212012-12-21 12:26:38 +08001413
Gerd Hoffmanne68c5952013-02-25 10:16:46 +01001414 fprintf(stderr, "char device redirected to %s (label %s)\n",
Michael Tokarev4efeabb2013-06-05 18:44:54 +04001415 pty_name, id);
Markus Armbrustera4e26042011-11-11 10:40:05 +01001416
Markus Armbruster2d528d42015-09-14 13:54:03 +02001417 s = g_new0(PtyCharDriver, 1);
aliguori6f97dba2008-10-31 18:49:55 +00001418 chr->opaque = s;
1419 chr->chr_write = pty_chr_write;
1420 chr->chr_update_read_handler = pty_chr_update_read_handler;
1421 chr->chr_close = pty_chr_close;
Anthony Liguorie6a87ed2013-03-05 23:21:24 +05301422 chr->chr_add_watch = pty_chr_add_watch;
Michael Rothbd5c51e2013-06-07 15:19:53 -05001423 chr->explicit_be_open = true;
aliguori6f97dba2008-10-31 18:49:55 +00001424
Anthony Liguori093d3a22013-03-05 23:21:20 +05301425 s->fd = io_channel_from_fd(master_fd);
Anthony Liguori8aa33ca2013-03-05 23:21:26 +05301426 s->timer_tag = 0;
aliguori6f97dba2008-10-31 18:49:55 +00001427
Markus Armbruster1f514702012-02-07 15:09:08 +01001428 return chr;
aliguori6f97dba2008-10-31 18:49:55 +00001429}
1430
1431static void tty_serial_init(int fd, int speed,
1432 int parity, int data_bits, int stop_bits)
1433{
1434 struct termios tty;
1435 speed_t spd;
1436
1437#if 0
1438 printf("tty_serial_init: speed=%d parity=%c data=%d stop=%d\n",
1439 speed, parity, data_bits, stop_bits);
1440#endif
1441 tcgetattr (fd, &tty);
1442
Stefan Weil45eea132009-10-26 16:10:10 +01001443#define check_speed(val) if (speed <= val) { spd = B##val; break; }
1444 speed = speed * 10 / 11;
1445 do {
1446 check_speed(50);
1447 check_speed(75);
1448 check_speed(110);
1449 check_speed(134);
1450 check_speed(150);
1451 check_speed(200);
1452 check_speed(300);
1453 check_speed(600);
1454 check_speed(1200);
1455 check_speed(1800);
1456 check_speed(2400);
1457 check_speed(4800);
1458 check_speed(9600);
1459 check_speed(19200);
1460 check_speed(38400);
1461 /* Non-Posix values follow. They may be unsupported on some systems. */
1462 check_speed(57600);
1463 check_speed(115200);
1464#ifdef B230400
1465 check_speed(230400);
1466#endif
1467#ifdef B460800
1468 check_speed(460800);
1469#endif
1470#ifdef B500000
1471 check_speed(500000);
1472#endif
1473#ifdef B576000
1474 check_speed(576000);
1475#endif
1476#ifdef B921600
1477 check_speed(921600);
1478#endif
1479#ifdef B1000000
1480 check_speed(1000000);
1481#endif
1482#ifdef B1152000
1483 check_speed(1152000);
1484#endif
1485#ifdef B1500000
1486 check_speed(1500000);
1487#endif
1488#ifdef B2000000
1489 check_speed(2000000);
1490#endif
1491#ifdef B2500000
1492 check_speed(2500000);
1493#endif
1494#ifdef B3000000
1495 check_speed(3000000);
1496#endif
1497#ifdef B3500000
1498 check_speed(3500000);
1499#endif
1500#ifdef B4000000
1501 check_speed(4000000);
1502#endif
aliguori6f97dba2008-10-31 18:49:55 +00001503 spd = B115200;
Stefan Weil45eea132009-10-26 16:10:10 +01001504 } while (0);
aliguori6f97dba2008-10-31 18:49:55 +00001505
1506 cfsetispeed(&tty, spd);
1507 cfsetospeed(&tty, spd);
1508
1509 tty.c_iflag &= ~(IGNBRK|BRKINT|PARMRK|ISTRIP
1510 |INLCR|IGNCR|ICRNL|IXON);
1511 tty.c_oflag |= OPOST;
1512 tty.c_lflag &= ~(ECHO|ECHONL|ICANON|IEXTEN|ISIG);
1513 tty.c_cflag &= ~(CSIZE|PARENB|PARODD|CRTSCTS|CSTOPB);
1514 switch(data_bits) {
1515 default:
1516 case 8:
1517 tty.c_cflag |= CS8;
1518 break;
1519 case 7:
1520 tty.c_cflag |= CS7;
1521 break;
1522 case 6:
1523 tty.c_cflag |= CS6;
1524 break;
1525 case 5:
1526 tty.c_cflag |= CS5;
1527 break;
1528 }
1529 switch(parity) {
1530 default:
1531 case 'N':
1532 break;
1533 case 'E':
1534 tty.c_cflag |= PARENB;
1535 break;
1536 case 'O':
1537 tty.c_cflag |= PARENB | PARODD;
1538 break;
1539 }
1540 if (stop_bits == 2)
1541 tty.c_cflag |= CSTOPB;
1542
1543 tcsetattr (fd, TCSANOW, &tty);
1544}
1545
1546static int tty_serial_ioctl(CharDriverState *chr, int cmd, void *arg)
1547{
1548 FDCharDriver *s = chr->opaque;
1549
1550 switch(cmd) {
1551 case CHR_IOCTL_SERIAL_SET_PARAMS:
1552 {
1553 QEMUSerialSetParams *ssp = arg;
Anthony Liguoria29753f2013-03-05 23:21:19 +05301554 tty_serial_init(g_io_channel_unix_get_fd(s->fd_in),
1555 ssp->speed, ssp->parity,
aliguori6f97dba2008-10-31 18:49:55 +00001556 ssp->data_bits, ssp->stop_bits);
1557 }
1558 break;
1559 case CHR_IOCTL_SERIAL_SET_BREAK:
1560 {
1561 int enable = *(int *)arg;
Anthony Liguoria29753f2013-03-05 23:21:19 +05301562 if (enable) {
1563 tcsendbreak(g_io_channel_unix_get_fd(s->fd_in), 1);
1564 }
aliguori6f97dba2008-10-31 18:49:55 +00001565 }
1566 break;
1567 case CHR_IOCTL_SERIAL_GET_TIOCM:
1568 {
1569 int sarg = 0;
1570 int *targ = (int *)arg;
Anthony Liguoria29753f2013-03-05 23:21:19 +05301571 ioctl(g_io_channel_unix_get_fd(s->fd_in), TIOCMGET, &sarg);
aliguori6f97dba2008-10-31 18:49:55 +00001572 *targ = 0;
aurel32b4abdfa2009-02-08 14:46:17 +00001573 if (sarg & TIOCM_CTS)
aliguori6f97dba2008-10-31 18:49:55 +00001574 *targ |= CHR_TIOCM_CTS;
aurel32b4abdfa2009-02-08 14:46:17 +00001575 if (sarg & TIOCM_CAR)
aliguori6f97dba2008-10-31 18:49:55 +00001576 *targ |= CHR_TIOCM_CAR;
aurel32b4abdfa2009-02-08 14:46:17 +00001577 if (sarg & TIOCM_DSR)
aliguori6f97dba2008-10-31 18:49:55 +00001578 *targ |= CHR_TIOCM_DSR;
aurel32b4abdfa2009-02-08 14:46:17 +00001579 if (sarg & TIOCM_RI)
aliguori6f97dba2008-10-31 18:49:55 +00001580 *targ |= CHR_TIOCM_RI;
aurel32b4abdfa2009-02-08 14:46:17 +00001581 if (sarg & TIOCM_DTR)
aliguori6f97dba2008-10-31 18:49:55 +00001582 *targ |= CHR_TIOCM_DTR;
aurel32b4abdfa2009-02-08 14:46:17 +00001583 if (sarg & TIOCM_RTS)
aliguori6f97dba2008-10-31 18:49:55 +00001584 *targ |= CHR_TIOCM_RTS;
1585 }
1586 break;
1587 case CHR_IOCTL_SERIAL_SET_TIOCM:
1588 {
1589 int sarg = *(int *)arg;
1590 int targ = 0;
Anthony Liguoria29753f2013-03-05 23:21:19 +05301591 ioctl(g_io_channel_unix_get_fd(s->fd_in), TIOCMGET, &targ);
aurel32b4abdfa2009-02-08 14:46:17 +00001592 targ &= ~(CHR_TIOCM_CTS | CHR_TIOCM_CAR | CHR_TIOCM_DSR
1593 | CHR_TIOCM_RI | CHR_TIOCM_DTR | CHR_TIOCM_RTS);
1594 if (sarg & CHR_TIOCM_CTS)
1595 targ |= TIOCM_CTS;
1596 if (sarg & CHR_TIOCM_CAR)
1597 targ |= TIOCM_CAR;
1598 if (sarg & CHR_TIOCM_DSR)
1599 targ |= TIOCM_DSR;
1600 if (sarg & CHR_TIOCM_RI)
1601 targ |= TIOCM_RI;
1602 if (sarg & CHR_TIOCM_DTR)
aliguori6f97dba2008-10-31 18:49:55 +00001603 targ |= TIOCM_DTR;
aurel32b4abdfa2009-02-08 14:46:17 +00001604 if (sarg & CHR_TIOCM_RTS)
aliguori6f97dba2008-10-31 18:49:55 +00001605 targ |= TIOCM_RTS;
Anthony Liguoria29753f2013-03-05 23:21:19 +05301606 ioctl(g_io_channel_unix_get_fd(s->fd_in), TIOCMSET, &targ);
aliguori6f97dba2008-10-31 18:49:55 +00001607 }
1608 break;
1609 default:
1610 return -ENOTSUP;
1611 }
1612 return 0;
1613}
1614
David Ahern4266a132010-02-10 18:27:17 -07001615static void qemu_chr_close_tty(CharDriverState *chr)
1616{
1617 FDCharDriver *s = chr->opaque;
1618 int fd = -1;
1619
1620 if (s) {
Anthony Liguoria29753f2013-03-05 23:21:19 +05301621 fd = g_io_channel_unix_get_fd(s->fd_in);
David Ahern4266a132010-02-10 18:27:17 -07001622 }
1623
1624 fd_chr_close(chr);
1625
1626 if (fd >= 0) {
1627 close(fd);
1628 }
1629}
1630
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01001631static CharDriverState *qemu_chr_open_tty_fd(int fd)
1632{
1633 CharDriverState *chr;
1634
1635 tty_serial_init(fd, 115200, 'N', 8, 1);
1636 chr = qemu_chr_open_fd(fd, fd);
1637 chr->chr_ioctl = tty_serial_ioctl;
1638 chr->chr_close = qemu_chr_close_tty;
1639 return chr;
1640}
aliguori6f97dba2008-10-31 18:49:55 +00001641#endif /* __linux__ || __sun__ */
1642
1643#if defined(__linux__)
Gerd Hoffmanne5514982012-12-19 16:35:42 +01001644
1645#define HAVE_CHARDEV_PARPORT 1
1646
aliguori6f97dba2008-10-31 18:49:55 +00001647typedef struct {
1648 int fd;
1649 int mode;
1650} ParallelCharDriver;
1651
1652static int pp_hw_mode(ParallelCharDriver *s, uint16_t mode)
1653{
1654 if (s->mode != mode) {
1655 int m = mode;
1656 if (ioctl(s->fd, PPSETMODE, &m) < 0)
1657 return 0;
1658 s->mode = mode;
1659 }
1660 return 1;
1661}
1662
1663static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
1664{
1665 ParallelCharDriver *drv = chr->opaque;
1666 int fd = drv->fd;
1667 uint8_t b;
1668
1669 switch(cmd) {
1670 case CHR_IOCTL_PP_READ_DATA:
1671 if (ioctl(fd, PPRDATA, &b) < 0)
1672 return -ENOTSUP;
1673 *(uint8_t *)arg = b;
1674 break;
1675 case CHR_IOCTL_PP_WRITE_DATA:
1676 b = *(uint8_t *)arg;
1677 if (ioctl(fd, PPWDATA, &b) < 0)
1678 return -ENOTSUP;
1679 break;
1680 case CHR_IOCTL_PP_READ_CONTROL:
1681 if (ioctl(fd, PPRCONTROL, &b) < 0)
1682 return -ENOTSUP;
1683 /* Linux gives only the lowest bits, and no way to know data
1684 direction! For better compatibility set the fixed upper
1685 bits. */
1686 *(uint8_t *)arg = b | 0xc0;
1687 break;
1688 case CHR_IOCTL_PP_WRITE_CONTROL:
1689 b = *(uint8_t *)arg;
1690 if (ioctl(fd, PPWCONTROL, &b) < 0)
1691 return -ENOTSUP;
1692 break;
1693 case CHR_IOCTL_PP_READ_STATUS:
1694 if (ioctl(fd, PPRSTATUS, &b) < 0)
1695 return -ENOTSUP;
1696 *(uint8_t *)arg = b;
1697 break;
1698 case CHR_IOCTL_PP_DATA_DIR:
1699 if (ioctl(fd, PPDATADIR, (int *)arg) < 0)
1700 return -ENOTSUP;
1701 break;
1702 case CHR_IOCTL_PP_EPP_READ_ADDR:
1703 if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
1704 struct ParallelIOArg *parg = arg;
1705 int n = read(fd, parg->buffer, parg->count);
1706 if (n != parg->count) {
1707 return -EIO;
1708 }
1709 }
1710 break;
1711 case CHR_IOCTL_PP_EPP_READ:
1712 if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
1713 struct ParallelIOArg *parg = arg;
1714 int n = read(fd, parg->buffer, parg->count);
1715 if (n != parg->count) {
1716 return -EIO;
1717 }
1718 }
1719 break;
1720 case CHR_IOCTL_PP_EPP_WRITE_ADDR:
1721 if (pp_hw_mode(drv, IEEE1284_MODE_EPP|IEEE1284_ADDR)) {
1722 struct ParallelIOArg *parg = arg;
1723 int n = write(fd, parg->buffer, parg->count);
1724 if (n != parg->count) {
1725 return -EIO;
1726 }
1727 }
1728 break;
1729 case CHR_IOCTL_PP_EPP_WRITE:
1730 if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
1731 struct ParallelIOArg *parg = arg;
1732 int n = write(fd, parg->buffer, parg->count);
1733 if (n != parg->count) {
1734 return -EIO;
1735 }
1736 }
1737 break;
1738 default:
1739 return -ENOTSUP;
1740 }
1741 return 0;
1742}
1743
1744static void pp_close(CharDriverState *chr)
1745{
1746 ParallelCharDriver *drv = chr->opaque;
1747 int fd = drv->fd;
1748
1749 pp_hw_mode(drv, IEEE1284_MODE_COMPAT);
1750 ioctl(fd, PPRELEASE);
1751 close(fd);
Anthony Liguori7267c092011-08-20 22:09:37 -05001752 g_free(drv);
Hans de Goedea425d232011-11-19 10:22:43 +01001753 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
aliguori6f97dba2008-10-31 18:49:55 +00001754}
1755
Gerd Hoffmann88a946d2013-01-10 14:20:58 +01001756static CharDriverState *qemu_chr_open_pp_fd(int fd)
aliguori6f97dba2008-10-31 18:49:55 +00001757{
1758 CharDriverState *chr;
1759 ParallelCharDriver *drv;
aliguori6f97dba2008-10-31 18:49:55 +00001760
1761 if (ioctl(fd, PPCLAIM) < 0) {
1762 close(fd);
Markus Armbruster1f514702012-02-07 15:09:08 +01001763 return NULL;
aliguori6f97dba2008-10-31 18:49:55 +00001764 }
1765
Markus Armbruster2d528d42015-09-14 13:54:03 +02001766 drv = g_new0(ParallelCharDriver, 1);
aliguori6f97dba2008-10-31 18:49:55 +00001767 drv->fd = fd;
1768 drv->mode = IEEE1284_MODE_COMPAT;
1769
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02001770 chr = qemu_chr_alloc();
aliguori6f97dba2008-10-31 18:49:55 +00001771 chr->chr_write = null_chr_write;
1772 chr->chr_ioctl = pp_ioctl;
1773 chr->chr_close = pp_close;
1774 chr->opaque = drv;
1775
Markus Armbruster1f514702012-02-07 15:09:08 +01001776 return chr;
aliguori6f97dba2008-10-31 18:49:55 +00001777}
1778#endif /* __linux__ */
1779
Aurelien Jarnoa167ba52009-11-29 18:00:41 +01001780#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__DragonFly__)
Gerd Hoffmanne5514982012-12-19 16:35:42 +01001781
1782#define HAVE_CHARDEV_PARPORT 1
1783
blueswir16972f932008-11-22 20:49:12 +00001784static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
1785{
Stefan Weile0efb992011-02-23 19:09:16 +01001786 int fd = (int)(intptr_t)chr->opaque;
blueswir16972f932008-11-22 20:49:12 +00001787 uint8_t b;
1788
1789 switch(cmd) {
1790 case CHR_IOCTL_PP_READ_DATA:
1791 if (ioctl(fd, PPIGDATA, &b) < 0)
1792 return -ENOTSUP;
1793 *(uint8_t *)arg = b;
1794 break;
1795 case CHR_IOCTL_PP_WRITE_DATA:
1796 b = *(uint8_t *)arg;
1797 if (ioctl(fd, PPISDATA, &b) < 0)
1798 return -ENOTSUP;
1799 break;
1800 case CHR_IOCTL_PP_READ_CONTROL:
1801 if (ioctl(fd, PPIGCTRL, &b) < 0)
1802 return -ENOTSUP;
1803 *(uint8_t *)arg = b;
1804 break;
1805 case CHR_IOCTL_PP_WRITE_CONTROL:
1806 b = *(uint8_t *)arg;
1807 if (ioctl(fd, PPISCTRL, &b) < 0)
1808 return -ENOTSUP;
1809 break;
1810 case CHR_IOCTL_PP_READ_STATUS:
1811 if (ioctl(fd, PPIGSTATUS, &b) < 0)
1812 return -ENOTSUP;
1813 *(uint8_t *)arg = b;
1814 break;
1815 default:
1816 return -ENOTSUP;
1817 }
1818 return 0;
1819}
1820
Gerd Hoffmann88a946d2013-01-10 14:20:58 +01001821static CharDriverState *qemu_chr_open_pp_fd(int fd)
blueswir16972f932008-11-22 20:49:12 +00001822{
1823 CharDriverState *chr;
blueswir16972f932008-11-22 20:49:12 +00001824
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02001825 chr = qemu_chr_alloc();
Stefan Weile0efb992011-02-23 19:09:16 +01001826 chr->opaque = (void *)(intptr_t)fd;
blueswir16972f932008-11-22 20:49:12 +00001827 chr->chr_write = null_chr_write;
1828 chr->chr_ioctl = pp_ioctl;
Michael Rothbd5c51e2013-06-07 15:19:53 -05001829 chr->explicit_be_open = true;
Markus Armbruster1f514702012-02-07 15:09:08 +01001830 return chr;
blueswir16972f932008-11-22 20:49:12 +00001831}
1832#endif
1833
aliguori6f97dba2008-10-31 18:49:55 +00001834#else /* _WIN32 */
1835
Paolo Bonzinid809ab92015-10-12 09:46:23 +02001836#define HAVE_CHARDEV_SERIAL 1
1837
aliguori6f97dba2008-10-31 18:49:55 +00001838typedef struct {
1839 int max_size;
1840 HANDLE hcom, hrecv, hsend;
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001841 OVERLAPPED orecv;
aliguori6f97dba2008-10-31 18:49:55 +00001842 BOOL fpipe;
1843 DWORD len;
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001844
1845 /* Protected by the CharDriverState chr_write_lock. */
1846 OVERLAPPED osend;
aliguori6f97dba2008-10-31 18:49:55 +00001847} WinCharState;
1848
Fabien Chouteaudb418a02011-10-06 16:37:51 +02001849typedef struct {
1850 HANDLE hStdIn;
1851 HANDLE hInputReadyEvent;
1852 HANDLE hInputDoneEvent;
1853 HANDLE hInputThread;
1854 uint8_t win_stdio_buf;
1855} WinStdioCharState;
1856
aliguori6f97dba2008-10-31 18:49:55 +00001857#define NSENDBUF 2048
1858#define NRECVBUF 2048
1859#define MAXCONNECT 1
1860#define NTIMEOUT 5000
1861
1862static int win_chr_poll(void *opaque);
1863static int win_chr_pipe_poll(void *opaque);
1864
1865static void win_chr_close(CharDriverState *chr)
1866{
1867 WinCharState *s = chr->opaque;
1868
1869 if (s->hsend) {
1870 CloseHandle(s->hsend);
1871 s->hsend = NULL;
1872 }
1873 if (s->hrecv) {
1874 CloseHandle(s->hrecv);
1875 s->hrecv = NULL;
1876 }
1877 if (s->hcom) {
1878 CloseHandle(s->hcom);
1879 s->hcom = NULL;
1880 }
1881 if (s->fpipe)
1882 qemu_del_polling_cb(win_chr_pipe_poll, chr);
1883 else
1884 qemu_del_polling_cb(win_chr_poll, chr);
Amit Shah793cbfb2009-08-11 21:27:48 +05301885
Hans de Goedea425d232011-11-19 10:22:43 +01001886 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
aliguori6f97dba2008-10-31 18:49:55 +00001887}
1888
Paolo Bonzini6511d392015-09-29 15:08:05 +02001889static int win_chr_init(CharDriverState *chr, const char *filename, Error **errp)
aliguori6f97dba2008-10-31 18:49:55 +00001890{
1891 WinCharState *s = chr->opaque;
1892 COMMCONFIG comcfg;
1893 COMMTIMEOUTS cto = { 0, 0, 0, 0, 0};
1894 COMSTAT comstat;
1895 DWORD size;
1896 DWORD err;
1897
1898 s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
1899 if (!s->hsend) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001900 error_setg(errp, "Failed CreateEvent");
aliguori6f97dba2008-10-31 18:49:55 +00001901 goto fail;
1902 }
1903 s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
1904 if (!s->hrecv) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001905 error_setg(errp, "Failed CreateEvent");
aliguori6f97dba2008-10-31 18:49:55 +00001906 goto fail;
1907 }
1908
1909 s->hcom = CreateFile(filename, GENERIC_READ|GENERIC_WRITE, 0, NULL,
1910 OPEN_EXISTING, FILE_FLAG_OVERLAPPED, 0);
1911 if (s->hcom == INVALID_HANDLE_VALUE) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001912 error_setg(errp, "Failed CreateFile (%lu)", GetLastError());
aliguori6f97dba2008-10-31 18:49:55 +00001913 s->hcom = NULL;
1914 goto fail;
1915 }
1916
1917 if (!SetupComm(s->hcom, NRECVBUF, NSENDBUF)) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001918 error_setg(errp, "Failed SetupComm");
aliguori6f97dba2008-10-31 18:49:55 +00001919 goto fail;
1920 }
1921
1922 ZeroMemory(&comcfg, sizeof(COMMCONFIG));
1923 size = sizeof(COMMCONFIG);
1924 GetDefaultCommConfig(filename, &comcfg, &size);
1925 comcfg.dcb.DCBlength = sizeof(DCB);
1926 CommConfigDialog(filename, NULL, &comcfg);
1927
1928 if (!SetCommState(s->hcom, &comcfg.dcb)) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001929 error_setg(errp, "Failed SetCommState");
aliguori6f97dba2008-10-31 18:49:55 +00001930 goto fail;
1931 }
1932
1933 if (!SetCommMask(s->hcom, EV_ERR)) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001934 error_setg(errp, "Failed SetCommMask");
aliguori6f97dba2008-10-31 18:49:55 +00001935 goto fail;
1936 }
1937
1938 cto.ReadIntervalTimeout = MAXDWORD;
1939 if (!SetCommTimeouts(s->hcom, &cto)) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001940 error_setg(errp, "Failed SetCommTimeouts");
aliguori6f97dba2008-10-31 18:49:55 +00001941 goto fail;
1942 }
1943
1944 if (!ClearCommError(s->hcom, &err, &comstat)) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001945 error_setg(errp, "Failed ClearCommError");
aliguori6f97dba2008-10-31 18:49:55 +00001946 goto fail;
1947 }
1948 qemu_add_polling_cb(win_chr_poll, chr);
1949 return 0;
1950
1951 fail:
1952 win_chr_close(chr);
1953 return -1;
1954}
1955
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001956/* Called with chr_write_lock held. */
aliguori6f97dba2008-10-31 18:49:55 +00001957static int win_chr_write(CharDriverState *chr, const uint8_t *buf, int len1)
1958{
1959 WinCharState *s = chr->opaque;
1960 DWORD len, ret, size, err;
1961
1962 len = len1;
1963 ZeroMemory(&s->osend, sizeof(s->osend));
1964 s->osend.hEvent = s->hsend;
1965 while (len > 0) {
1966 if (s->hsend)
1967 ret = WriteFile(s->hcom, buf, len, &size, &s->osend);
1968 else
1969 ret = WriteFile(s->hcom, buf, len, &size, NULL);
1970 if (!ret) {
1971 err = GetLastError();
1972 if (err == ERROR_IO_PENDING) {
1973 ret = GetOverlappedResult(s->hcom, &s->osend, &size, TRUE);
1974 if (ret) {
1975 buf += size;
1976 len -= size;
1977 } else {
1978 break;
1979 }
1980 } else {
1981 break;
1982 }
1983 } else {
1984 buf += size;
1985 len -= size;
1986 }
1987 }
1988 return len1 - len;
1989}
1990
1991static int win_chr_read_poll(CharDriverState *chr)
1992{
1993 WinCharState *s = chr->opaque;
1994
Anthony Liguori909cda12011-08-15 11:17:31 -05001995 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00001996 return s->max_size;
1997}
1998
1999static void win_chr_readfile(CharDriverState *chr)
2000{
2001 WinCharState *s = chr->opaque;
2002 int ret, err;
Amit Shah9bd78542009-11-03 19:59:54 +05302003 uint8_t buf[READ_BUF_LEN];
aliguori6f97dba2008-10-31 18:49:55 +00002004 DWORD size;
2005
2006 ZeroMemory(&s->orecv, sizeof(s->orecv));
2007 s->orecv.hEvent = s->hrecv;
2008 ret = ReadFile(s->hcom, buf, s->len, &size, &s->orecv);
2009 if (!ret) {
2010 err = GetLastError();
2011 if (err == ERROR_IO_PENDING) {
2012 ret = GetOverlappedResult(s->hcom, &s->orecv, &size, TRUE);
2013 }
2014 }
2015
2016 if (size > 0) {
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05002017 qemu_chr_be_write(chr, buf, size);
aliguori6f97dba2008-10-31 18:49:55 +00002018 }
2019}
2020
2021static void win_chr_read(CharDriverState *chr)
2022{
2023 WinCharState *s = chr->opaque;
2024
2025 if (s->len > s->max_size)
2026 s->len = s->max_size;
2027 if (s->len == 0)
2028 return;
2029
2030 win_chr_readfile(chr);
2031}
2032
2033static int win_chr_poll(void *opaque)
2034{
2035 CharDriverState *chr = opaque;
2036 WinCharState *s = chr->opaque;
2037 COMSTAT status;
2038 DWORD comerr;
2039
2040 ClearCommError(s->hcom, &comerr, &status);
2041 if (status.cbInQue > 0) {
2042 s->len = status.cbInQue;
2043 win_chr_read_poll(chr);
2044 win_chr_read(chr);
2045 return 1;
2046 }
2047 return 0;
2048}
2049
Paolo Bonzini6511d392015-09-29 15:08:05 +02002050static CharDriverState *qemu_chr_open_win_path(const char *filename,
2051 Error **errp)
aliguori6f97dba2008-10-31 18:49:55 +00002052{
2053 CharDriverState *chr;
2054 WinCharState *s;
2055
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02002056 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02002057 s = g_new0(WinCharState, 1);
aliguori6f97dba2008-10-31 18:49:55 +00002058 chr->opaque = s;
2059 chr->chr_write = win_chr_write;
2060 chr->chr_close = win_chr_close;
2061
Paolo Bonzini6511d392015-09-29 15:08:05 +02002062 if (win_chr_init(chr, filename, errp) < 0) {
Stefan Weil2e02e182011-10-07 07:38:46 +02002063 g_free(s);
2064 g_free(chr);
Markus Armbruster1f514702012-02-07 15:09:08 +01002065 return NULL;
aliguori6f97dba2008-10-31 18:49:55 +00002066 }
Markus Armbruster1f514702012-02-07 15:09:08 +01002067 return chr;
aliguori6f97dba2008-10-31 18:49:55 +00002068}
2069
2070static int win_chr_pipe_poll(void *opaque)
2071{
2072 CharDriverState *chr = opaque;
2073 WinCharState *s = chr->opaque;
2074 DWORD size;
2075
2076 PeekNamedPipe(s->hcom, NULL, 0, NULL, &size, NULL);
2077 if (size > 0) {
2078 s->len = size;
2079 win_chr_read_poll(chr);
2080 win_chr_read(chr);
2081 return 1;
2082 }
2083 return 0;
2084}
2085
2086static int win_chr_pipe_init(CharDriverState *chr, const char *filename)
2087{
2088 WinCharState *s = chr->opaque;
2089 OVERLAPPED ov;
2090 int ret;
2091 DWORD size;
Corey Minyard9f781162014-10-02 11:17:33 -05002092 char openname[CHR_MAX_FILENAME_SIZE];
aliguori6f97dba2008-10-31 18:49:55 +00002093
2094 s->fpipe = TRUE;
2095
2096 s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
2097 if (!s->hsend) {
2098 fprintf(stderr, "Failed CreateEvent\n");
2099 goto fail;
2100 }
2101 s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
2102 if (!s->hrecv) {
2103 fprintf(stderr, "Failed CreateEvent\n");
2104 goto fail;
2105 }
2106
2107 snprintf(openname, sizeof(openname), "\\\\.\\pipe\\%s", filename);
2108 s->hcom = CreateNamedPipe(openname, PIPE_ACCESS_DUPLEX | FILE_FLAG_OVERLAPPED,
2109 PIPE_TYPE_BYTE | PIPE_READMODE_BYTE |
2110 PIPE_WAIT,
2111 MAXCONNECT, NSENDBUF, NRECVBUF, NTIMEOUT, NULL);
2112 if (s->hcom == INVALID_HANDLE_VALUE) {
2113 fprintf(stderr, "Failed CreateNamedPipe (%lu)\n", GetLastError());
2114 s->hcom = NULL;
2115 goto fail;
2116 }
2117
2118 ZeroMemory(&ov, sizeof(ov));
2119 ov.hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
2120 ret = ConnectNamedPipe(s->hcom, &ov);
2121 if (ret) {
2122 fprintf(stderr, "Failed ConnectNamedPipe\n");
2123 goto fail;
2124 }
2125
2126 ret = GetOverlappedResult(s->hcom, &ov, &size, TRUE);
2127 if (!ret) {
2128 fprintf(stderr, "Failed GetOverlappedResult\n");
2129 if (ov.hEvent) {
2130 CloseHandle(ov.hEvent);
2131 ov.hEvent = NULL;
2132 }
2133 goto fail;
2134 }
2135
2136 if (ov.hEvent) {
2137 CloseHandle(ov.hEvent);
2138 ov.hEvent = NULL;
2139 }
2140 qemu_add_polling_cb(win_chr_pipe_poll, chr);
2141 return 0;
2142
2143 fail:
2144 win_chr_close(chr);
2145 return -1;
2146}
2147
2148
Gerd Hoffmann548cbb32013-02-25 11:50:55 +01002149static CharDriverState *qemu_chr_open_pipe(ChardevHostdev *opts)
aliguori6f97dba2008-10-31 18:49:55 +00002150{
Gerd Hoffmann548cbb32013-02-25 11:50:55 +01002151 const char *filename = opts->device;
aliguori6f97dba2008-10-31 18:49:55 +00002152 CharDriverState *chr;
2153 WinCharState *s;
2154
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02002155 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02002156 s = g_new0(WinCharState, 1);
aliguori6f97dba2008-10-31 18:49:55 +00002157 chr->opaque = s;
2158 chr->chr_write = win_chr_write;
2159 chr->chr_close = win_chr_close;
2160
2161 if (win_chr_pipe_init(chr, filename) < 0) {
Stefan Weil2e02e182011-10-07 07:38:46 +02002162 g_free(s);
2163 g_free(chr);
Markus Armbruster1f514702012-02-07 15:09:08 +01002164 return NULL;
aliguori6f97dba2008-10-31 18:49:55 +00002165 }
Markus Armbruster1f514702012-02-07 15:09:08 +01002166 return chr;
aliguori6f97dba2008-10-31 18:49:55 +00002167}
2168
Markus Armbruster1f514702012-02-07 15:09:08 +01002169static CharDriverState *qemu_chr_open_win_file(HANDLE fd_out)
aliguori6f97dba2008-10-31 18:49:55 +00002170{
2171 CharDriverState *chr;
2172 WinCharState *s;
2173
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02002174 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02002175 s = g_new0(WinCharState, 1);
aliguori6f97dba2008-10-31 18:49:55 +00002176 s->hcom = fd_out;
2177 chr->opaque = s;
2178 chr->chr_write = win_chr_write;
Markus Armbruster1f514702012-02-07 15:09:08 +01002179 return chr;
aliguori6f97dba2008-10-31 18:49:55 +00002180}
2181
Gerd Hoffmannd9ac3742013-02-25 11:48:06 +01002182static CharDriverState *qemu_chr_open_win_con(void)
aliguori6f97dba2008-10-31 18:49:55 +00002183{
Markus Armbruster1f514702012-02-07 15:09:08 +01002184 return qemu_chr_open_win_file(GetStdHandle(STD_OUTPUT_HANDLE));
aliguori6f97dba2008-10-31 18:49:55 +00002185}
2186
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002187static int win_stdio_write(CharDriverState *chr, const uint8_t *buf, int len)
2188{
2189 HANDLE hStdOut = GetStdHandle(STD_OUTPUT_HANDLE);
2190 DWORD dwSize;
2191 int len1;
2192
2193 len1 = len;
2194
2195 while (len1 > 0) {
2196 if (!WriteFile(hStdOut, buf, len1, &dwSize, NULL)) {
2197 break;
2198 }
2199 buf += dwSize;
2200 len1 -= dwSize;
2201 }
2202
2203 return len - len1;
2204}
2205
2206static void win_stdio_wait_func(void *opaque)
2207{
2208 CharDriverState *chr = opaque;
2209 WinStdioCharState *stdio = chr->opaque;
2210 INPUT_RECORD buf[4];
2211 int ret;
2212 DWORD dwSize;
2213 int i;
2214
Stefan Weildff74242013-12-07 14:48:04 +01002215 ret = ReadConsoleInput(stdio->hStdIn, buf, ARRAY_SIZE(buf), &dwSize);
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002216
2217 if (!ret) {
2218 /* Avoid error storm */
2219 qemu_del_wait_object(stdio->hStdIn, NULL, NULL);
2220 return;
2221 }
2222
2223 for (i = 0; i < dwSize; i++) {
2224 KEY_EVENT_RECORD *kev = &buf[i].Event.KeyEvent;
2225
2226 if (buf[i].EventType == KEY_EVENT && kev->bKeyDown) {
2227 int j;
2228 if (kev->uChar.AsciiChar != 0) {
2229 for (j = 0; j < kev->wRepeatCount; j++) {
2230 if (qemu_chr_be_can_write(chr)) {
2231 uint8_t c = kev->uChar.AsciiChar;
2232 qemu_chr_be_write(chr, &c, 1);
2233 }
2234 }
2235 }
2236 }
2237 }
2238}
2239
2240static DWORD WINAPI win_stdio_thread(LPVOID param)
2241{
2242 CharDriverState *chr = param;
2243 WinStdioCharState *stdio = chr->opaque;
2244 int ret;
2245 DWORD dwSize;
2246
2247 while (1) {
2248
2249 /* Wait for one byte */
2250 ret = ReadFile(stdio->hStdIn, &stdio->win_stdio_buf, 1, &dwSize, NULL);
2251
2252 /* Exit in case of error, continue if nothing read */
2253 if (!ret) {
2254 break;
2255 }
2256 if (!dwSize) {
2257 continue;
2258 }
2259
2260 /* Some terminal emulator returns \r\n for Enter, just pass \n */
2261 if (stdio->win_stdio_buf == '\r') {
2262 continue;
2263 }
2264
2265 /* Signal the main thread and wait until the byte was eaten */
2266 if (!SetEvent(stdio->hInputReadyEvent)) {
2267 break;
2268 }
2269 if (WaitForSingleObject(stdio->hInputDoneEvent, INFINITE)
2270 != WAIT_OBJECT_0) {
2271 break;
2272 }
2273 }
2274
2275 qemu_del_wait_object(stdio->hInputReadyEvent, NULL, NULL);
2276 return 0;
2277}
2278
2279static void win_stdio_thread_wait_func(void *opaque)
2280{
2281 CharDriverState *chr = opaque;
2282 WinStdioCharState *stdio = chr->opaque;
2283
2284 if (qemu_chr_be_can_write(chr)) {
2285 qemu_chr_be_write(chr, &stdio->win_stdio_buf, 1);
2286 }
2287
2288 SetEvent(stdio->hInputDoneEvent);
2289}
2290
2291static void qemu_chr_set_echo_win_stdio(CharDriverState *chr, bool echo)
2292{
2293 WinStdioCharState *stdio = chr->opaque;
2294 DWORD dwMode = 0;
2295
2296 GetConsoleMode(stdio->hStdIn, &dwMode);
2297
2298 if (echo) {
2299 SetConsoleMode(stdio->hStdIn, dwMode | ENABLE_ECHO_INPUT);
2300 } else {
2301 SetConsoleMode(stdio->hStdIn, dwMode & ~ENABLE_ECHO_INPUT);
2302 }
2303}
2304
2305static void win_stdio_close(CharDriverState *chr)
2306{
2307 WinStdioCharState *stdio = chr->opaque;
2308
2309 if (stdio->hInputReadyEvent != INVALID_HANDLE_VALUE) {
2310 CloseHandle(stdio->hInputReadyEvent);
2311 }
2312 if (stdio->hInputDoneEvent != INVALID_HANDLE_VALUE) {
2313 CloseHandle(stdio->hInputDoneEvent);
2314 }
2315 if (stdio->hInputThread != INVALID_HANDLE_VALUE) {
2316 TerminateThread(stdio->hInputThread, 0);
2317 }
2318
2319 g_free(chr->opaque);
2320 g_free(chr);
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002321}
2322
Gerd Hoffmann7c358032013-02-21 12:34:58 +01002323static CharDriverState *qemu_chr_open_stdio(ChardevStdio *opts)
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002324{
2325 CharDriverState *chr;
2326 WinStdioCharState *stdio;
2327 DWORD dwMode;
2328 int is_console = 0;
2329
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02002330 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02002331 stdio = g_new0(WinStdioCharState, 1);
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002332
2333 stdio->hStdIn = GetStdHandle(STD_INPUT_HANDLE);
2334 if (stdio->hStdIn == INVALID_HANDLE_VALUE) {
2335 fprintf(stderr, "cannot open stdio: invalid handle\n");
2336 exit(1);
2337 }
2338
2339 is_console = GetConsoleMode(stdio->hStdIn, &dwMode) != 0;
2340
2341 chr->opaque = stdio;
2342 chr->chr_write = win_stdio_write;
2343 chr->chr_close = win_stdio_close;
2344
Anthony Liguoried7a1542013-03-05 23:21:17 +05302345 if (is_console) {
2346 if (qemu_add_wait_object(stdio->hStdIn,
2347 win_stdio_wait_func, chr)) {
2348 fprintf(stderr, "qemu_add_wait_object: failed\n");
2349 }
2350 } else {
2351 DWORD dwId;
2352
2353 stdio->hInputReadyEvent = CreateEvent(NULL, FALSE, FALSE, NULL);
2354 stdio->hInputDoneEvent = CreateEvent(NULL, FALSE, FALSE, NULL);
2355 stdio->hInputThread = CreateThread(NULL, 0, win_stdio_thread,
2356 chr, 0, &dwId);
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002357
Anthony Liguoried7a1542013-03-05 23:21:17 +05302358 if (stdio->hInputThread == INVALID_HANDLE_VALUE
2359 || stdio->hInputReadyEvent == INVALID_HANDLE_VALUE
2360 || stdio->hInputDoneEvent == INVALID_HANDLE_VALUE) {
2361 fprintf(stderr, "cannot create stdio thread or event\n");
2362 exit(1);
2363 }
2364 if (qemu_add_wait_object(stdio->hInputReadyEvent,
2365 win_stdio_thread_wait_func, chr)) {
2366 fprintf(stderr, "qemu_add_wait_object: failed\n");
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002367 }
2368 }
2369
2370 dwMode |= ENABLE_LINE_INPUT;
2371
Anthony Liguoried7a1542013-03-05 23:21:17 +05302372 if (is_console) {
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002373 /* set the terminal in raw mode */
2374 /* ENABLE_QUICK_EDIT_MODE | ENABLE_EXTENDED_FLAGS */
2375 dwMode |= ENABLE_PROCESSED_INPUT;
2376 }
2377
2378 SetConsoleMode(stdio->hStdIn, dwMode);
2379
2380 chr->chr_set_echo = qemu_chr_set_echo_win_stdio;
2381 qemu_chr_fe_set_echo(chr, false);
2382
Markus Armbruster1f514702012-02-07 15:09:08 +01002383 return chr;
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002384}
aliguori6f97dba2008-10-31 18:49:55 +00002385#endif /* !_WIN32 */
2386
Anthony Liguori5ab82112013-03-05 23:21:31 +05302387
aliguori6f97dba2008-10-31 18:49:55 +00002388/***********************************************************/
2389/* UDP Net console */
2390
2391typedef struct {
2392 int fd;
Anthony Liguori76a96442013-03-05 23:21:21 +05302393 GIOChannel *chan;
Amit Shah9bd78542009-11-03 19:59:54 +05302394 uint8_t buf[READ_BUF_LEN];
aliguori6f97dba2008-10-31 18:49:55 +00002395 int bufcnt;
2396 int bufptr;
2397 int max_size;
2398} NetCharDriver;
2399
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02002400/* Called with chr_write_lock held. */
aliguori6f97dba2008-10-31 18:49:55 +00002401static int udp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2402{
2403 NetCharDriver *s = chr->opaque;
Anthony Liguori76a96442013-03-05 23:21:21 +05302404 gsize bytes_written;
2405 GIOStatus status;
aliguori6f97dba2008-10-31 18:49:55 +00002406
Anthony Liguori76a96442013-03-05 23:21:21 +05302407 status = g_io_channel_write_chars(s->chan, (const gchar *)buf, len, &bytes_written, NULL);
2408 if (status == G_IO_STATUS_EOF) {
2409 return 0;
2410 } else if (status != G_IO_STATUS_NORMAL) {
2411 return -1;
2412 }
2413
2414 return bytes_written;
aliguori6f97dba2008-10-31 18:49:55 +00002415}
2416
2417static int udp_chr_read_poll(void *opaque)
2418{
2419 CharDriverState *chr = opaque;
2420 NetCharDriver *s = chr->opaque;
2421
Anthony Liguori909cda12011-08-15 11:17:31 -05002422 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002423
2424 /* If there were any stray characters in the queue process them
2425 * first
2426 */
2427 while (s->max_size > 0 && s->bufptr < s->bufcnt) {
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05002428 qemu_chr_be_write(chr, &s->buf[s->bufptr], 1);
aliguori6f97dba2008-10-31 18:49:55 +00002429 s->bufptr++;
Anthony Liguori909cda12011-08-15 11:17:31 -05002430 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002431 }
2432 return s->max_size;
2433}
2434
Anthony Liguori76a96442013-03-05 23:21:21 +05302435static gboolean udp_chr_read(GIOChannel *chan, GIOCondition cond, void *opaque)
aliguori6f97dba2008-10-31 18:49:55 +00002436{
2437 CharDriverState *chr = opaque;
2438 NetCharDriver *s = chr->opaque;
Anthony Liguori76a96442013-03-05 23:21:21 +05302439 gsize bytes_read = 0;
2440 GIOStatus status;
aliguori6f97dba2008-10-31 18:49:55 +00002441
Paolo Bonzinicdbf6e12013-04-19 17:32:08 +02002442 if (s->max_size == 0) {
2443 return TRUE;
2444 }
Anthony Liguori76a96442013-03-05 23:21:21 +05302445 status = g_io_channel_read_chars(s->chan, (gchar *)s->buf, sizeof(s->buf),
2446 &bytes_read, NULL);
2447 s->bufcnt = bytes_read;
aliguori6f97dba2008-10-31 18:49:55 +00002448 s->bufptr = s->bufcnt;
Anthony Liguori76a96442013-03-05 23:21:21 +05302449 if (status != G_IO_STATUS_NORMAL) {
Amit Shah26da70c2013-08-28 15:23:37 +05302450 remove_fd_in_watch(chr);
Anthony Liguori76a96442013-03-05 23:21:21 +05302451 return FALSE;
2452 }
aliguori6f97dba2008-10-31 18:49:55 +00002453
2454 s->bufptr = 0;
2455 while (s->max_size > 0 && s->bufptr < s->bufcnt) {
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05002456 qemu_chr_be_write(chr, &s->buf[s->bufptr], 1);
aliguori6f97dba2008-10-31 18:49:55 +00002457 s->bufptr++;
Anthony Liguori909cda12011-08-15 11:17:31 -05002458 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002459 }
Anthony Liguori76a96442013-03-05 23:21:21 +05302460
2461 return TRUE;
aliguori6f97dba2008-10-31 18:49:55 +00002462}
2463
2464static void udp_chr_update_read_handler(CharDriverState *chr)
2465{
2466 NetCharDriver *s = chr->opaque;
2467
Amit Shah26da70c2013-08-28 15:23:37 +05302468 remove_fd_in_watch(chr);
Anthony Liguori76a96442013-03-05 23:21:21 +05302469 if (s->chan) {
Amit Shah7ba9add2013-08-28 15:18:29 +05302470 chr->fd_in_tag = io_add_watch_poll(s->chan, udp_chr_read_poll,
2471 udp_chr_read, chr);
aliguori6f97dba2008-10-31 18:49:55 +00002472 }
2473}
2474
aliguori819f56b2009-03-28 17:58:14 +00002475static void udp_chr_close(CharDriverState *chr)
2476{
2477 NetCharDriver *s = chr->opaque;
Amit Shah26da70c2013-08-28 15:23:37 +05302478
2479 remove_fd_in_watch(chr);
Anthony Liguori76a96442013-03-05 23:21:21 +05302480 if (s->chan) {
2481 g_io_channel_unref(s->chan);
aliguori819f56b2009-03-28 17:58:14 +00002482 closesocket(s->fd);
2483 }
Anthony Liguori7267c092011-08-20 22:09:37 -05002484 g_free(s);
Hans de Goedea425d232011-11-19 10:22:43 +01002485 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
aliguori819f56b2009-03-28 17:58:14 +00002486}
2487
Gerd Hoffmann3ecc0592013-02-27 14:10:47 +01002488static CharDriverState *qemu_chr_open_udp_fd(int fd)
aliguori6f97dba2008-10-31 18:49:55 +00002489{
2490 CharDriverState *chr = NULL;
2491 NetCharDriver *s = NULL;
aliguori6f97dba2008-10-31 18:49:55 +00002492
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02002493 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02002494 s = g_new0(NetCharDriver, 1);
aliguori6f97dba2008-10-31 18:49:55 +00002495
aliguori6f97dba2008-10-31 18:49:55 +00002496 s->fd = fd;
Anthony Liguori76a96442013-03-05 23:21:21 +05302497 s->chan = io_channel_from_socket(s->fd);
aliguori6f97dba2008-10-31 18:49:55 +00002498 s->bufcnt = 0;
2499 s->bufptr = 0;
2500 chr->opaque = s;
2501 chr->chr_write = udp_chr_write;
2502 chr->chr_update_read_handler = udp_chr_update_read_handler;
aliguori819f56b2009-03-28 17:58:14 +00002503 chr->chr_close = udp_chr_close;
Michael Rothbd5c51e2013-06-07 15:19:53 -05002504 /* be isn't opened until we get a connection */
2505 chr->explicit_be_open = true;
Markus Armbruster1f514702012-02-07 15:09:08 +01002506 return chr;
Gerd Hoffmann3ecc0592013-02-27 14:10:47 +01002507}
aliguori6f97dba2008-10-31 18:49:55 +00002508
aliguori6f97dba2008-10-31 18:49:55 +00002509/***********************************************************/
2510/* TCP Net console */
2511
2512typedef struct {
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302513
2514 GIOChannel *chan, *listen_chan;
Amit Shah7ba9add2013-08-28 15:18:29 +05302515 guint listen_tag;
aliguori6f97dba2008-10-31 18:49:55 +00002516 int fd, listen_fd;
2517 int connected;
2518 int max_size;
2519 int do_telnetopt;
2520 int do_nodelay;
2521 int is_unix;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002522 int *read_msgfds;
2523 int read_msgfds_num;
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002524 int *write_msgfds;
2525 int write_msgfds_num;
Corey Minyardcfb429c2014-10-02 11:17:35 -05002526
2527 SocketAddress *addr;
2528 bool is_listen;
2529 bool is_telnet;
Corey Minyard5dd1f022014-10-02 11:17:37 -05002530
2531 guint reconnect_timer;
2532 int64_t reconnect_time;
Corey Minyard5008e5b2014-10-08 07:11:55 -05002533 bool connect_err_reported;
aliguori6f97dba2008-10-31 18:49:55 +00002534} TCPCharDriver;
2535
Corey Minyard5dd1f022014-10-02 11:17:37 -05002536static gboolean socket_reconnect_timeout(gpointer opaque);
2537
2538static void qemu_chr_socket_restart_timer(CharDriverState *chr)
2539{
2540 TCPCharDriver *s = chr->opaque;
2541 assert(s->connected == 0);
2542 s->reconnect_timer = g_timeout_add_seconds(s->reconnect_time,
2543 socket_reconnect_timeout, chr);
2544}
2545
Corey Minyard5008e5b2014-10-08 07:11:55 -05002546static void check_report_connect_error(CharDriverState *chr,
2547 Error *err)
2548{
2549 TCPCharDriver *s = chr->opaque;
2550
2551 if (!s->connect_err_reported) {
2552 error_report("Unable to connect character device %s: %s",
2553 chr->label, error_get_pretty(err));
2554 s->connect_err_reported = true;
2555 }
2556 qemu_chr_socket_restart_timer(chr);
2557}
2558
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302559static gboolean tcp_chr_accept(GIOChannel *chan, GIOCondition cond, void *opaque);
aliguori6f97dba2008-10-31 18:49:55 +00002560
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002561#ifndef _WIN32
2562static int unix_send_msgfds(CharDriverState *chr, const uint8_t *buf, int len)
2563{
2564 TCPCharDriver *s = chr->opaque;
2565 struct msghdr msgh;
2566 struct iovec iov;
2567 int r;
2568
2569 size_t fd_size = s->write_msgfds_num * sizeof(int);
2570 char control[CMSG_SPACE(fd_size)];
2571 struct cmsghdr *cmsg;
2572
2573 memset(&msgh, 0, sizeof(msgh));
2574 memset(control, 0, sizeof(control));
2575
2576 /* set the payload */
2577 iov.iov_base = (uint8_t *) buf;
2578 iov.iov_len = len;
2579
2580 msgh.msg_iov = &iov;
2581 msgh.msg_iovlen = 1;
2582
2583 msgh.msg_control = control;
2584 msgh.msg_controllen = sizeof(control);
2585
2586 cmsg = CMSG_FIRSTHDR(&msgh);
2587
2588 cmsg->cmsg_len = CMSG_LEN(fd_size);
2589 cmsg->cmsg_level = SOL_SOCKET;
2590 cmsg->cmsg_type = SCM_RIGHTS;
2591 memcpy(CMSG_DATA(cmsg), s->write_msgfds, fd_size);
2592
2593 do {
2594 r = sendmsg(s->fd, &msgh, 0);
2595 } while (r < 0 && errno == EINTR);
2596
2597 /* free the written msgfds, no matter what */
2598 if (s->write_msgfds_num) {
2599 g_free(s->write_msgfds);
2600 s->write_msgfds = 0;
2601 s->write_msgfds_num = 0;
2602 }
2603
2604 return r;
2605}
2606#endif
2607
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02002608/* Called with chr_write_lock held. */
aliguori6f97dba2008-10-31 18:49:55 +00002609static int tcp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2610{
2611 TCPCharDriver *s = chr->opaque;
2612 if (s->connected) {
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002613#ifndef _WIN32
2614 if (s->is_unix && s->write_msgfds_num) {
2615 return unix_send_msgfds(chr, buf, len);
2616 } else
2617#endif
2618 {
2619 return io_channel_send(s->chan, buf, len);
2620 }
Anthony Liguori455aa1e2012-09-05 13:52:49 -05002621 } else {
Anthony Liguori6db0fdc2012-09-12 14:34:07 -05002622 /* XXX: indicate an error ? */
Anthony Liguori455aa1e2012-09-05 13:52:49 -05002623 return len;
aliguori6f97dba2008-10-31 18:49:55 +00002624 }
2625}
2626
2627static int tcp_chr_read_poll(void *opaque)
2628{
2629 CharDriverState *chr = opaque;
2630 TCPCharDriver *s = chr->opaque;
2631 if (!s->connected)
2632 return 0;
Anthony Liguori909cda12011-08-15 11:17:31 -05002633 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002634 return s->max_size;
2635}
2636
2637#define IAC 255
2638#define IAC_BREAK 243
2639static void tcp_chr_process_IAC_bytes(CharDriverState *chr,
2640 TCPCharDriver *s,
2641 uint8_t *buf, int *size)
2642{
2643 /* Handle any telnet client's basic IAC options to satisfy char by
2644 * char mode with no echo. All IAC options will be removed from
2645 * the buf and the do_telnetopt variable will be used to track the
2646 * state of the width of the IAC information.
2647 *
2648 * IAC commands come in sets of 3 bytes with the exception of the
2649 * "IAC BREAK" command and the double IAC.
2650 */
2651
2652 int i;
2653 int j = 0;
2654
2655 for (i = 0; i < *size; i++) {
2656 if (s->do_telnetopt > 1) {
2657 if ((unsigned char)buf[i] == IAC && s->do_telnetopt == 2) {
2658 /* Double IAC means send an IAC */
2659 if (j != i)
2660 buf[j] = buf[i];
2661 j++;
2662 s->do_telnetopt = 1;
2663 } else {
2664 if ((unsigned char)buf[i] == IAC_BREAK && s->do_telnetopt == 2) {
2665 /* Handle IAC break commands by sending a serial break */
Hans de Goedea425d232011-11-19 10:22:43 +01002666 qemu_chr_be_event(chr, CHR_EVENT_BREAK);
aliguori6f97dba2008-10-31 18:49:55 +00002667 s->do_telnetopt++;
2668 }
2669 s->do_telnetopt++;
2670 }
2671 if (s->do_telnetopt >= 4) {
2672 s->do_telnetopt = 1;
2673 }
2674 } else {
2675 if ((unsigned char)buf[i] == IAC) {
2676 s->do_telnetopt = 2;
2677 } else {
2678 if (j != i)
2679 buf[j] = buf[i];
2680 j++;
2681 }
2682 }
2683 }
2684 *size = j;
2685}
2686
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002687static int tcp_get_msgfds(CharDriverState *chr, int *fds, int num)
Mark McLoughlin7d174052009-07-22 09:11:39 +01002688{
2689 TCPCharDriver *s = chr->opaque;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002690 int to_copy = (s->read_msgfds_num < num) ? s->read_msgfds_num : num;
2691
Michael S. Tsirkinc4095722014-11-02 18:48:32 +02002692 assert(num <= TCP_MAX_FDS);
2693
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002694 if (to_copy) {
Stefan Hajnoczid2fc39b2014-06-22 10:38:37 +08002695 int i;
2696
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002697 memcpy(fds, s->read_msgfds, to_copy * sizeof(int));
2698
Stefan Hajnoczid2fc39b2014-06-22 10:38:37 +08002699 /* Close unused fds */
2700 for (i = to_copy; i < s->read_msgfds_num; i++) {
2701 close(s->read_msgfds[i]);
2702 }
2703
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002704 g_free(s->read_msgfds);
2705 s->read_msgfds = 0;
2706 s->read_msgfds_num = 0;
2707 }
2708
2709 return to_copy;
Mark McLoughlin7d174052009-07-22 09:11:39 +01002710}
2711
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002712static int tcp_set_msgfds(CharDriverState *chr, int *fds, int num)
2713{
2714 TCPCharDriver *s = chr->opaque;
2715
2716 /* clear old pending fd array */
Daniel P. Berrangeef1e1e02015-08-26 12:17:18 +01002717 g_free(s->write_msgfds);
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002718
2719 if (num) {
Markus Armbruster2d528d42015-09-14 13:54:03 +02002720 s->write_msgfds = g_new(int, num);
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002721 memcpy(s->write_msgfds, fds, num * sizeof(int));
2722 }
2723
2724 s->write_msgfds_num = num;
2725
2726 return 0;
2727}
2728
Anthony Liguori73bcc2a2009-07-27 14:55:25 -05002729#ifndef _WIN32
Mark McLoughlin7d174052009-07-22 09:11:39 +01002730static void unix_process_msgfd(CharDriverState *chr, struct msghdr *msg)
2731{
2732 TCPCharDriver *s = chr->opaque;
2733 struct cmsghdr *cmsg;
2734
2735 for (cmsg = CMSG_FIRSTHDR(msg); cmsg; cmsg = CMSG_NXTHDR(msg, cmsg)) {
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002736 int fd_size, i;
Mark McLoughlin7d174052009-07-22 09:11:39 +01002737
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002738 if (cmsg->cmsg_len < CMSG_LEN(sizeof(int)) ||
Mark McLoughlin7d174052009-07-22 09:11:39 +01002739 cmsg->cmsg_level != SOL_SOCKET ||
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002740 cmsg->cmsg_type != SCM_RIGHTS) {
Mark McLoughlin7d174052009-07-22 09:11:39 +01002741 continue;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002742 }
Mark McLoughlin7d174052009-07-22 09:11:39 +01002743
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002744 fd_size = cmsg->cmsg_len - CMSG_LEN(0);
2745
2746 if (!fd_size) {
Mark McLoughlin7d174052009-07-22 09:11:39 +01002747 continue;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002748 }
Mark McLoughlin7d174052009-07-22 09:11:39 +01002749
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002750 /* close and clean read_msgfds */
2751 for (i = 0; i < s->read_msgfds_num; i++) {
2752 close(s->read_msgfds[i]);
2753 }
Stefan Hajnoczi9b938c72013-03-27 10:10:46 +01002754
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002755 if (s->read_msgfds_num) {
2756 g_free(s->read_msgfds);
2757 }
2758
2759 s->read_msgfds_num = fd_size / sizeof(int);
2760 s->read_msgfds = g_malloc(fd_size);
2761 memcpy(s->read_msgfds, CMSG_DATA(cmsg), fd_size);
2762
2763 for (i = 0; i < s->read_msgfds_num; i++) {
2764 int fd = s->read_msgfds[i];
2765 if (fd < 0) {
2766 continue;
2767 }
2768
2769 /* O_NONBLOCK is preserved across SCM_RIGHTS so reset it */
2770 qemu_set_block(fd);
2771
2772 #ifndef MSG_CMSG_CLOEXEC
2773 qemu_set_cloexec(fd);
2774 #endif
2775 }
Mark McLoughlin7d174052009-07-22 09:11:39 +01002776 }
2777}
2778
Mark McLoughlin9977c892009-07-22 09:11:38 +01002779static ssize_t tcp_chr_recv(CharDriverState *chr, char *buf, size_t len)
2780{
2781 TCPCharDriver *s = chr->opaque;
Blue Swirl7cba04f2009-08-01 10:13:20 +00002782 struct msghdr msg = { NULL, };
Mark McLoughlin9977c892009-07-22 09:11:38 +01002783 struct iovec iov[1];
Mark McLoughlin7d174052009-07-22 09:11:39 +01002784 union {
2785 struct cmsghdr cmsg;
Michael S. Tsirkinc4095722014-11-02 18:48:32 +02002786 char control[CMSG_SPACE(sizeof(int) * TCP_MAX_FDS)];
Mark McLoughlin7d174052009-07-22 09:11:39 +01002787 } msg_control;
Corey Bryant06138652012-08-14 16:43:42 -04002788 int flags = 0;
Mark McLoughlin7d174052009-07-22 09:11:39 +01002789 ssize_t ret;
Mark McLoughlin9977c892009-07-22 09:11:38 +01002790
2791 iov[0].iov_base = buf;
2792 iov[0].iov_len = len;
2793
2794 msg.msg_iov = iov;
2795 msg.msg_iovlen = 1;
Mark McLoughlin7d174052009-07-22 09:11:39 +01002796 msg.msg_control = &msg_control;
2797 msg.msg_controllen = sizeof(msg_control);
Mark McLoughlin9977c892009-07-22 09:11:38 +01002798
Corey Bryant06138652012-08-14 16:43:42 -04002799#ifdef MSG_CMSG_CLOEXEC
2800 flags |= MSG_CMSG_CLOEXEC;
2801#endif
Paolo Bonzini9172f422015-07-21 09:25:54 +02002802 do {
2803 ret = recvmsg(s->fd, &msg, flags);
2804 } while (ret == -1 && errno == EINTR);
2805
Corey Bryant06138652012-08-14 16:43:42 -04002806 if (ret > 0 && s->is_unix) {
Mark McLoughlin7d174052009-07-22 09:11:39 +01002807 unix_process_msgfd(chr, &msg);
Corey Bryant06138652012-08-14 16:43:42 -04002808 }
Mark McLoughlin7d174052009-07-22 09:11:39 +01002809
2810 return ret;
Mark McLoughlin9977c892009-07-22 09:11:38 +01002811}
2812#else
2813static ssize_t tcp_chr_recv(CharDriverState *chr, char *buf, size_t len)
2814{
2815 TCPCharDriver *s = chr->opaque;
Paolo Bonzini9172f422015-07-21 09:25:54 +02002816 ssize_t ret;
2817
2818 do {
2819 ret = qemu_recv(s->fd, buf, len, 0);
2820 } while (ret == -1 && socket_error() == EINTR);
2821
2822 return ret;
Mark McLoughlin9977c892009-07-22 09:11:38 +01002823}
2824#endif
2825
Amit Shahd3cc5bc2013-03-05 23:21:25 +05302826static GSource *tcp_chr_add_watch(CharDriverState *chr, GIOCondition cond)
2827{
2828 TCPCharDriver *s = chr->opaque;
2829 return g_io_create_watch(s->chan, cond);
2830}
2831
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +03002832static void tcp_chr_disconnect(CharDriverState *chr)
2833{
2834 TCPCharDriver *s = chr->opaque;
2835
2836 s->connected = 0;
2837 if (s->listen_chan) {
2838 s->listen_tag = g_io_add_watch(s->listen_chan, G_IO_IN,
2839 tcp_chr_accept, chr);
2840 }
2841 remove_fd_in_watch(chr);
2842 g_io_channel_unref(s->chan);
2843 s->chan = NULL;
2844 closesocket(s->fd);
2845 s->fd = -1;
Corey Minyard16cc4ff2014-10-02 11:17:36 -05002846 SocketAddress_to_str(chr->filename, CHR_MAX_FILENAME_SIZE,
2847 "disconnected:", s->addr, s->is_listen, s->is_telnet);
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +03002848 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
Corey Minyard5dd1f022014-10-02 11:17:37 -05002849 if (s->reconnect_time) {
2850 qemu_chr_socket_restart_timer(chr);
2851 }
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +03002852}
2853
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302854static gboolean tcp_chr_read(GIOChannel *chan, GIOCondition cond, void *opaque)
aliguori6f97dba2008-10-31 18:49:55 +00002855{
2856 CharDriverState *chr = opaque;
2857 TCPCharDriver *s = chr->opaque;
Amit Shah9bd78542009-11-03 19:59:54 +05302858 uint8_t buf[READ_BUF_LEN];
aliguori6f97dba2008-10-31 18:49:55 +00002859 int len, size;
2860
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302861 if (!s->connected || s->max_size <= 0) {
Paolo Bonzinicdbf6e12013-04-19 17:32:08 +02002862 return TRUE;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302863 }
aliguori6f97dba2008-10-31 18:49:55 +00002864 len = sizeof(buf);
2865 if (len > s->max_size)
2866 len = s->max_size;
Mark McLoughlin9977c892009-07-22 09:11:38 +01002867 size = tcp_chr_recv(chr, (void *)buf, len);
Nils Carlson4bf1cb02015-07-19 20:39:56 +00002868 if (size == 0 ||
2869 (size < 0 &&
2870 socket_error() != EAGAIN && socket_error() != EWOULDBLOCK)) {
aliguori6f97dba2008-10-31 18:49:55 +00002871 /* connection closed */
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +03002872 tcp_chr_disconnect(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002873 } else if (size > 0) {
2874 if (s->do_telnetopt)
2875 tcp_chr_process_IAC_bytes(chr, s, buf, &size);
2876 if (size > 0)
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05002877 qemu_chr_be_write(chr, buf, size);
aliguori6f97dba2008-10-31 18:49:55 +00002878 }
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302879
2880 return TRUE;
aliguori6f97dba2008-10-31 18:49:55 +00002881}
2882
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +03002883static int tcp_chr_sync_read(CharDriverState *chr, const uint8_t *buf, int len)
2884{
2885 TCPCharDriver *s = chr->opaque;
2886 int size;
2887
2888 if (!s->connected) {
2889 return 0;
2890 }
2891
2892 size = tcp_chr_recv(chr, (void *) buf, len);
2893 if (size == 0) {
2894 /* connection closed */
2895 tcp_chr_disconnect(chr);
2896 }
2897
2898 return size;
2899}
2900
Blue Swirl68c18d12010-08-15 09:46:24 +00002901#ifndef _WIN32
2902CharDriverState *qemu_chr_open_eventfd(int eventfd)
2903{
David Marchande9d21c42014-06-11 17:25:16 +02002904 CharDriverState *chr = qemu_chr_open_fd(eventfd, eventfd);
2905
2906 if (chr) {
2907 chr->avail_connections = 1;
2908 }
2909
2910 return chr;
Cam Macdonell6cbf4c82010-07-27 10:54:13 -06002911}
Blue Swirl68c18d12010-08-15 09:46:24 +00002912#endif
Cam Macdonell6cbf4c82010-07-27 10:54:13 -06002913
aliguori6f97dba2008-10-31 18:49:55 +00002914static void tcp_chr_connect(void *opaque)
2915{
2916 CharDriverState *chr = opaque;
2917 TCPCharDriver *s = chr->opaque;
Corey Minyard01ca5192014-10-02 11:17:38 -05002918 struct sockaddr_storage ss, ps;
2919 socklen_t ss_len = sizeof(ss), ps_len = sizeof(ps);
Corey Minyard16cc4ff2014-10-02 11:17:36 -05002920
2921 memset(&ss, 0, ss_len);
2922 if (getsockname(s->fd, (struct sockaddr *) &ss, &ss_len) != 0) {
2923 snprintf(chr->filename, CHR_MAX_FILENAME_SIZE,
2924 "Error in getsockname: %s\n", strerror(errno));
Corey Minyard01ca5192014-10-02 11:17:38 -05002925 } else if (getpeername(s->fd, (struct sockaddr *) &ps, &ps_len) != 0) {
2926 snprintf(chr->filename, CHR_MAX_FILENAME_SIZE,
2927 "Error in getpeername: %s\n", strerror(errno));
Corey Minyard16cc4ff2014-10-02 11:17:36 -05002928 } else {
Corey Minyard01ca5192014-10-02 11:17:38 -05002929 sockaddr_to_str(chr->filename, CHR_MAX_FILENAME_SIZE,
2930 &ss, ss_len, &ps, ps_len,
Corey Minyard16cc4ff2014-10-02 11:17:36 -05002931 s->is_listen, s->is_telnet);
2932 }
aliguori6f97dba2008-10-31 18:49:55 +00002933
2934 s->connected = 1;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302935 if (s->chan) {
Amit Shah7ba9add2013-08-28 15:18:29 +05302936 chr->fd_in_tag = io_add_watch_poll(s->chan, tcp_chr_read_poll,
2937 tcp_chr_read, chr);
David Gibsonbbdd2ad2012-09-10 12:30:56 +10002938 }
Hans de Goedefee204f2013-03-26 11:07:54 +01002939 qemu_chr_be_generic_open(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002940}
2941
Gal Hammerac1b84d2014-02-25 12:12:35 +02002942static void tcp_chr_update_read_handler(CharDriverState *chr)
2943{
2944 TCPCharDriver *s = chr->opaque;
2945
2946 remove_fd_in_watch(chr);
2947 if (s->chan) {
2948 chr->fd_in_tag = io_add_watch_poll(s->chan, tcp_chr_read_poll,
2949 tcp_chr_read, chr);
2950 }
2951}
2952
aliguori6f97dba2008-10-31 18:49:55 +00002953#define IACSET(x,a,b,c) x[0] = a; x[1] = b; x[2] = c;
2954static void tcp_chr_telnet_init(int fd)
2955{
2956 char buf[3];
2957 /* Send the telnet negotion to put telnet in binary, no echo, single char mode */
2958 IACSET(buf, 0xff, 0xfb, 0x01); /* IAC WILL ECHO */
2959 send(fd, (char *)buf, 3, 0);
2960 IACSET(buf, 0xff, 0xfb, 0x03); /* IAC WILL Suppress go ahead */
2961 send(fd, (char *)buf, 3, 0);
2962 IACSET(buf, 0xff, 0xfb, 0x00); /* IAC WILL Binary */
2963 send(fd, (char *)buf, 3, 0);
2964 IACSET(buf, 0xff, 0xfd, 0x00); /* IAC DO Binary */
2965 send(fd, (char *)buf, 3, 0);
2966}
2967
Daniel P. Berrange13661082011-06-23 13:31:42 +01002968static int tcp_chr_add_client(CharDriverState *chr, int fd)
2969{
2970 TCPCharDriver *s = chr->opaque;
2971 if (s->fd != -1)
2972 return -1;
2973
Stefan Hajnoczif9e8cac2013-03-27 10:10:43 +01002974 qemu_set_nonblock(fd);
Daniel P. Berrange13661082011-06-23 13:31:42 +01002975 if (s->do_nodelay)
2976 socket_set_nodelay(fd);
2977 s->fd = fd;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302978 s->chan = io_channel_from_socket(fd);
Paolo Bonzini910b6362013-04-19 17:32:06 +02002979 if (s->listen_tag) {
2980 g_source_remove(s->listen_tag);
2981 s->listen_tag = 0;
2982 }
Daniel P. Berrange13661082011-06-23 13:31:42 +01002983 tcp_chr_connect(chr);
2984
2985 return 0;
2986}
2987
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302988static gboolean tcp_chr_accept(GIOChannel *channel, GIOCondition cond, void *opaque)
aliguori6f97dba2008-10-31 18:49:55 +00002989{
2990 CharDriverState *chr = opaque;
2991 TCPCharDriver *s = chr->opaque;
2992 struct sockaddr_in saddr;
2993#ifndef _WIN32
2994 struct sockaddr_un uaddr;
2995#endif
2996 struct sockaddr *addr;
2997 socklen_t len;
2998 int fd;
2999
3000 for(;;) {
3001#ifndef _WIN32
3002 if (s->is_unix) {
3003 len = sizeof(uaddr);
3004 addr = (struct sockaddr *)&uaddr;
3005 } else
3006#endif
3007 {
3008 len = sizeof(saddr);
3009 addr = (struct sockaddr *)&saddr;
3010 }
Kevin Wolf40ff6d72009-12-02 12:24:42 +01003011 fd = qemu_accept(s->listen_fd, addr, &len);
aliguori6f97dba2008-10-31 18:49:55 +00003012 if (fd < 0 && errno != EINTR) {
Hans de Goede79f20072013-04-25 13:53:02 +02003013 s->listen_tag = 0;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303014 return FALSE;
aliguori6f97dba2008-10-31 18:49:55 +00003015 } else if (fd >= 0) {
3016 if (s->do_telnetopt)
3017 tcp_chr_telnet_init(fd);
3018 break;
3019 }
3020 }
Daniel P. Berrange13661082011-06-23 13:31:42 +01003021 if (tcp_chr_add_client(chr, fd) < 0)
3022 close(fd);
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303023
3024 return TRUE;
aliguori6f97dba2008-10-31 18:49:55 +00003025}
3026
3027static void tcp_chr_close(CharDriverState *chr)
3028{
3029 TCPCharDriver *s = chr->opaque;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03003030 int i;
Corey Minyardcfb429c2014-10-02 11:17:35 -05003031
Corey Minyard5dd1f022014-10-02 11:17:37 -05003032 if (s->reconnect_timer) {
3033 g_source_remove(s->reconnect_timer);
3034 s->reconnect_timer = 0;
3035 }
Corey Minyardcfb429c2014-10-02 11:17:35 -05003036 qapi_free_SocketAddress(s->addr);
aliguori819f56b2009-03-28 17:58:14 +00003037 if (s->fd >= 0) {
Amit Shah26da70c2013-08-28 15:23:37 +05303038 remove_fd_in_watch(chr);
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303039 if (s->chan) {
3040 g_io_channel_unref(s->chan);
3041 }
aliguori6f97dba2008-10-31 18:49:55 +00003042 closesocket(s->fd);
aliguori819f56b2009-03-28 17:58:14 +00003043 }
3044 if (s->listen_fd >= 0) {
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303045 if (s->listen_tag) {
3046 g_source_remove(s->listen_tag);
Paolo Bonzini910b6362013-04-19 17:32:06 +02003047 s->listen_tag = 0;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303048 }
3049 if (s->listen_chan) {
3050 g_io_channel_unref(s->listen_chan);
3051 }
aliguori6f97dba2008-10-31 18:49:55 +00003052 closesocket(s->listen_fd);
aliguori819f56b2009-03-28 17:58:14 +00003053 }
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03003054 if (s->read_msgfds_num) {
3055 for (i = 0; i < s->read_msgfds_num; i++) {
3056 close(s->read_msgfds[i]);
3057 }
3058 g_free(s->read_msgfds);
3059 }
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03003060 if (s->write_msgfds_num) {
3061 g_free(s->write_msgfds);
3062 }
Anthony Liguori7267c092011-08-20 22:09:37 -05003063 g_free(s);
Hans de Goedea425d232011-11-19 10:22:43 +01003064 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
aliguori6f97dba2008-10-31 18:49:55 +00003065}
3066
Corey Minyard16cc4ff2014-10-02 11:17:36 -05003067static void qemu_chr_finish_socket_connection(CharDriverState *chr, int fd)
aliguori6f97dba2008-10-31 18:49:55 +00003068{
Corey Minyard43ded1a2014-10-02 11:17:34 -05003069 TCPCharDriver *s = chr->opaque;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003070
Corey Minyardcfb429c2014-10-02 11:17:35 -05003071 if (s->is_listen) {
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003072 s->listen_fd = fd;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303073 s->listen_chan = io_channel_from_socket(s->listen_fd);
Corey Minyard43ded1a2014-10-02 11:17:34 -05003074 s->listen_tag = g_io_add_watch(s->listen_chan, G_IO_IN,
3075 tcp_chr_accept, chr);
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003076 } else {
3077 s->connected = 1;
3078 s->fd = fd;
3079 socket_set_nodelay(fd);
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303080 s->chan = io_channel_from_socket(s->fd);
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003081 tcp_chr_connect(chr);
3082 }
Corey Minyard43ded1a2014-10-02 11:17:34 -05003083}
3084
Corey Minyard51795022014-10-08 07:11:56 -05003085static void qemu_chr_socket_connected(int fd, Error *err, void *opaque)
Corey Minyard5dd1f022014-10-02 11:17:37 -05003086{
3087 CharDriverState *chr = opaque;
Corey Minyard5008e5b2014-10-08 07:11:55 -05003088 TCPCharDriver *s = chr->opaque;
Corey Minyard5dd1f022014-10-02 11:17:37 -05003089
3090 if (fd < 0) {
Corey Minyard5008e5b2014-10-08 07:11:55 -05003091 check_report_connect_error(chr, err);
Corey Minyard5dd1f022014-10-02 11:17:37 -05003092 return;
3093 }
3094
Corey Minyard5008e5b2014-10-08 07:11:55 -05003095 s->connect_err_reported = false;
Corey Minyard5dd1f022014-10-02 11:17:37 -05003096 qemu_chr_finish_socket_connection(chr, fd);
3097}
3098
Corey Minyardcfb429c2014-10-02 11:17:35 -05003099static bool qemu_chr_open_socket_fd(CharDriverState *chr, Error **errp)
Corey Minyard43ded1a2014-10-02 11:17:34 -05003100{
Corey Minyardcfb429c2014-10-02 11:17:35 -05003101 TCPCharDriver *s = chr->opaque;
Corey Minyard43ded1a2014-10-02 11:17:34 -05003102 int fd;
3103
Corey Minyardcfb429c2014-10-02 11:17:35 -05003104 if (s->is_listen) {
3105 fd = socket_listen(s->addr, errp);
Corey Minyard5dd1f022014-10-02 11:17:37 -05003106 } else if (s->reconnect_time) {
3107 fd = socket_connect(s->addr, errp, qemu_chr_socket_connected, chr);
3108 return fd >= 0;
3109 } else {
Corey Minyardcfb429c2014-10-02 11:17:35 -05003110 fd = socket_connect(s->addr, errp, NULL, NULL);
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003111 }
Corey Minyard43ded1a2014-10-02 11:17:34 -05003112 if (fd < 0) {
3113 return false;
3114 }
3115
Corey Minyard16cc4ff2014-10-02 11:17:36 -05003116 qemu_chr_finish_socket_connection(chr, fd);
3117 return true;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003118}
3119
Lei Li51767e72013-01-25 00:03:19 +08003120/*********************************************************/
Markus Armbruster3949e592013-02-06 21:27:24 +01003121/* Ring buffer chardev */
Lei Li51767e72013-01-25 00:03:19 +08003122
3123typedef struct {
3124 size_t size;
3125 size_t prod;
3126 size_t cons;
3127 uint8_t *cbuf;
Markus Armbruster3949e592013-02-06 21:27:24 +01003128} RingBufCharDriver;
Lei Li51767e72013-01-25 00:03:19 +08003129
Markus Armbruster3949e592013-02-06 21:27:24 +01003130static size_t ringbuf_count(const CharDriverState *chr)
Lei Li51767e72013-01-25 00:03:19 +08003131{
Markus Armbruster3949e592013-02-06 21:27:24 +01003132 const RingBufCharDriver *d = chr->opaque;
Lei Li51767e72013-01-25 00:03:19 +08003133
Markus Armbruster5c230102013-02-06 21:27:23 +01003134 return d->prod - d->cons;
Lei Li51767e72013-01-25 00:03:19 +08003135}
3136
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02003137/* Called with chr_write_lock held. */
Markus Armbruster3949e592013-02-06 21:27:24 +01003138static int ringbuf_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
Lei Li51767e72013-01-25 00:03:19 +08003139{
Markus Armbruster3949e592013-02-06 21:27:24 +01003140 RingBufCharDriver *d = chr->opaque;
Lei Li51767e72013-01-25 00:03:19 +08003141 int i;
3142
3143 if (!buf || (len < 0)) {
3144 return -1;
3145 }
3146
3147 for (i = 0; i < len; i++ ) {
Markus Armbruster5c230102013-02-06 21:27:23 +01003148 d->cbuf[d->prod++ & (d->size - 1)] = buf[i];
3149 if (d->prod - d->cons > d->size) {
Lei Li51767e72013-01-25 00:03:19 +08003150 d->cons = d->prod - d->size;
3151 }
3152 }
3153
3154 return 0;
3155}
3156
Markus Armbruster3949e592013-02-06 21:27:24 +01003157static int ringbuf_chr_read(CharDriverState *chr, uint8_t *buf, int len)
Lei Li51767e72013-01-25 00:03:19 +08003158{
Markus Armbruster3949e592013-02-06 21:27:24 +01003159 RingBufCharDriver *d = chr->opaque;
Lei Li51767e72013-01-25 00:03:19 +08003160 int i;
3161
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02003162 qemu_mutex_lock(&chr->chr_write_lock);
Markus Armbruster5c230102013-02-06 21:27:23 +01003163 for (i = 0; i < len && d->cons != d->prod; i++) {
3164 buf[i] = d->cbuf[d->cons++ & (d->size - 1)];
Lei Li51767e72013-01-25 00:03:19 +08003165 }
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02003166 qemu_mutex_unlock(&chr->chr_write_lock);
Lei Li51767e72013-01-25 00:03:19 +08003167
3168 return i;
3169}
3170
Markus Armbruster3949e592013-02-06 21:27:24 +01003171static void ringbuf_chr_close(struct CharDriverState *chr)
Lei Li51767e72013-01-25 00:03:19 +08003172{
Markus Armbruster3949e592013-02-06 21:27:24 +01003173 RingBufCharDriver *d = chr->opaque;
Lei Li51767e72013-01-25 00:03:19 +08003174
3175 g_free(d->cbuf);
3176 g_free(d);
3177 chr->opaque = NULL;
3178}
3179
Markus Armbruster4f573782013-07-26 16:44:32 +02003180static CharDriverState *qemu_chr_open_ringbuf(ChardevRingbuf *opts,
3181 Error **errp)
Lei Li51767e72013-01-25 00:03:19 +08003182{
3183 CharDriverState *chr;
Markus Armbruster3949e592013-02-06 21:27:24 +01003184 RingBufCharDriver *d;
Lei Li51767e72013-01-25 00:03:19 +08003185
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02003186 chr = qemu_chr_alloc();
Lei Li51767e72013-01-25 00:03:19 +08003187 d = g_malloc(sizeof(*d));
3188
Gerd Hoffmann1da48c62013-02-26 16:21:11 +01003189 d->size = opts->has_size ? opts->size : 65536;
Lei Li51767e72013-01-25 00:03:19 +08003190
3191 /* The size must be power of 2 */
3192 if (d->size & (d->size - 1)) {
Markus Armbruster4f573782013-07-26 16:44:32 +02003193 error_setg(errp, "size of ringbuf chardev must be power of two");
Lei Li51767e72013-01-25 00:03:19 +08003194 goto fail;
3195 }
3196
3197 d->prod = 0;
3198 d->cons = 0;
3199 d->cbuf = g_malloc0(d->size);
3200
3201 chr->opaque = d;
Markus Armbruster3949e592013-02-06 21:27:24 +01003202 chr->chr_write = ringbuf_chr_write;
3203 chr->chr_close = ringbuf_chr_close;
Lei Li51767e72013-01-25 00:03:19 +08003204
3205 return chr;
3206
3207fail:
3208 g_free(d);
3209 g_free(chr);
3210 return NULL;
3211}
3212
Hani Benhabiles8e597772014-05-27 23:39:30 +01003213bool chr_is_ringbuf(const CharDriverState *chr)
Lei Li1f590cf2013-01-25 00:03:20 +08003214{
Markus Armbruster3949e592013-02-06 21:27:24 +01003215 return chr->chr_write == ringbuf_chr_write;
Lei Li1f590cf2013-01-25 00:03:20 +08003216}
3217
Markus Armbruster3949e592013-02-06 21:27:24 +01003218void qmp_ringbuf_write(const char *device, const char *data,
Markus Armbruster82e59a62013-02-06 21:27:14 +01003219 bool has_format, enum DataFormat format,
Lei Li1f590cf2013-01-25 00:03:20 +08003220 Error **errp)
3221{
3222 CharDriverState *chr;
Markus Armbrusterc4f331b2013-02-06 21:27:17 +01003223 const uint8_t *write_data;
Lei Li1f590cf2013-01-25 00:03:20 +08003224 int ret;
Peter Crosthwaite3d1bba22013-05-22 13:01:43 +10003225 gsize write_count;
Lei Li1f590cf2013-01-25 00:03:20 +08003226
3227 chr = qemu_chr_find(device);
3228 if (!chr) {
Markus Armbruster1a692782013-02-06 21:27:16 +01003229 error_setg(errp, "Device '%s' not found", device);
Lei Li1f590cf2013-01-25 00:03:20 +08003230 return;
3231 }
3232
Markus Armbruster3949e592013-02-06 21:27:24 +01003233 if (!chr_is_ringbuf(chr)) {
3234 error_setg(errp,"%s is not a ringbuf device", device);
Lei Li1f590cf2013-01-25 00:03:20 +08003235 return;
3236 }
3237
Lei Li1f590cf2013-01-25 00:03:20 +08003238 if (has_format && (format == DATA_FORMAT_BASE64)) {
3239 write_data = g_base64_decode(data, &write_count);
3240 } else {
3241 write_data = (uint8_t *)data;
Markus Armbruster82e59a62013-02-06 21:27:14 +01003242 write_count = strlen(data);
Lei Li1f590cf2013-01-25 00:03:20 +08003243 }
3244
Markus Armbruster3949e592013-02-06 21:27:24 +01003245 ret = ringbuf_chr_write(chr, write_data, write_count);
Lei Li1f590cf2013-01-25 00:03:20 +08003246
Markus Armbruster13289fb2013-02-06 21:27:18 +01003247 if (write_data != (uint8_t *)data) {
3248 g_free((void *)write_data);
3249 }
3250
Lei Li1f590cf2013-01-25 00:03:20 +08003251 if (ret < 0) {
3252 error_setg(errp, "Failed to write to device %s", device);
3253 return;
3254 }
3255}
3256
Markus Armbruster3949e592013-02-06 21:27:24 +01003257char *qmp_ringbuf_read(const char *device, int64_t size,
Markus Armbruster3ab651f2013-02-06 21:27:15 +01003258 bool has_format, enum DataFormat format,
3259 Error **errp)
Lei Li49b6d722013-01-25 00:03:21 +08003260{
3261 CharDriverState *chr;
Markus Armbrusterc4f331b2013-02-06 21:27:17 +01003262 uint8_t *read_data;
Lei Li49b6d722013-01-25 00:03:21 +08003263 size_t count;
Markus Armbruster3ab651f2013-02-06 21:27:15 +01003264 char *data;
Lei Li49b6d722013-01-25 00:03:21 +08003265
3266 chr = qemu_chr_find(device);
3267 if (!chr) {
Markus Armbruster1a692782013-02-06 21:27:16 +01003268 error_setg(errp, "Device '%s' not found", device);
Lei Li49b6d722013-01-25 00:03:21 +08003269 return NULL;
3270 }
3271
Markus Armbruster3949e592013-02-06 21:27:24 +01003272 if (!chr_is_ringbuf(chr)) {
3273 error_setg(errp,"%s is not a ringbuf device", device);
Lei Li49b6d722013-01-25 00:03:21 +08003274 return NULL;
3275 }
3276
3277 if (size <= 0) {
3278 error_setg(errp, "size must be greater than zero");
3279 return NULL;
3280 }
3281
Markus Armbruster3949e592013-02-06 21:27:24 +01003282 count = ringbuf_count(chr);
Lei Li49b6d722013-01-25 00:03:21 +08003283 size = size > count ? count : size;
Markus Armbruster44f3bcd2013-02-06 21:27:20 +01003284 read_data = g_malloc(size + 1);
Lei Li49b6d722013-01-25 00:03:21 +08003285
Markus Armbruster3949e592013-02-06 21:27:24 +01003286 ringbuf_chr_read(chr, read_data, size);
Lei Li49b6d722013-01-25 00:03:21 +08003287
3288 if (has_format && (format == DATA_FORMAT_BASE64)) {
Markus Armbruster3ab651f2013-02-06 21:27:15 +01003289 data = g_base64_encode(read_data, size);
Markus Armbruster13289fb2013-02-06 21:27:18 +01003290 g_free(read_data);
Lei Li49b6d722013-01-25 00:03:21 +08003291 } else {
Markus Armbruster3949e592013-02-06 21:27:24 +01003292 /*
3293 * FIXME should read only complete, valid UTF-8 characters up
3294 * to @size bytes. Invalid sequences should be replaced by a
3295 * suitable replacement character. Except when (and only
3296 * when) ring buffer lost characters since last read, initial
3297 * continuation characters should be dropped.
3298 */
Markus Armbruster44f3bcd2013-02-06 21:27:20 +01003299 read_data[size] = 0;
Markus Armbruster3ab651f2013-02-06 21:27:15 +01003300 data = (char *)read_data;
Lei Li49b6d722013-01-25 00:03:21 +08003301 }
3302
Markus Armbruster3ab651f2013-02-06 21:27:15 +01003303 return data;
Lei Li49b6d722013-01-25 00:03:21 +08003304}
3305
Gerd Hoffmann33521632009-12-08 13:11:49 +01003306QemuOpts *qemu_chr_parse_compat(const char *label, const char *filename)
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003307{
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003308 char host[65], port[33], width[8], height[8];
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003309 int pos;
Gerd Hoffmann7d315442009-09-10 10:58:36 +02003310 const char *p;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003311 QemuOpts *opts;
Luiz Capitulino8be7e7e2012-03-20 15:51:57 -03003312 Error *local_err = NULL;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003313
Luiz Capitulino8be7e7e2012-03-20 15:51:57 -03003314 opts = qemu_opts_create(qemu_find_opts("chardev"), label, 1, &local_err);
Markus Armbruster84d18f02014-01-30 15:07:28 +01003315 if (local_err) {
Markus Armbruster33394882015-02-10 15:21:26 +01003316 error_report_err(local_err);
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003317 return NULL;
Luiz Capitulino8be7e7e2012-03-20 15:51:57 -03003318 }
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003319
Gerd Hoffmann7591c5c2009-09-10 10:58:50 +02003320 if (strstart(filename, "mon:", &p)) {
3321 filename = p;
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003322 qemu_opt_set(opts, "mux", "on", &error_abort);
Paolo Bonzini02c4bdf2013-07-03 20:29:45 +04003323 if (strcmp(filename, "stdio") == 0) {
3324 /* Monitor is muxed to stdio: do not exit on Ctrl+C by default
3325 * but pass it to the guest. Handle this only for compat syntax,
3326 * for -chardev syntax we have special option for this.
3327 * This is what -nographic did, redirecting+muxing serial+monitor
3328 * to stdio causing Ctrl+C to be passed to guest. */
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003329 qemu_opt_set(opts, "signal", "off", &error_abort);
Paolo Bonzini02c4bdf2013-07-03 20:29:45 +04003330 }
Gerd Hoffmann7591c5c2009-09-10 10:58:50 +02003331 }
3332
Gerd Hoffmannf0457e82009-09-10 10:58:45 +02003333 if (strcmp(filename, "null") == 0 ||
3334 strcmp(filename, "pty") == 0 ||
3335 strcmp(filename, "msmouse") == 0 ||
Gerd Hoffmanndc1c21e2009-09-10 10:58:46 +02003336 strcmp(filename, "braille") == 0 ||
Paolo Bonzini56923992014-07-11 09:44:26 +02003337 strcmp(filename, "testdev") == 0 ||
Gerd Hoffmannf0457e82009-09-10 10:58:45 +02003338 strcmp(filename, "stdio") == 0) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003339 qemu_opt_set(opts, "backend", filename, &error_abort);
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003340 return opts;
3341 }
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003342 if (strstart(filename, "vc", &p)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003343 qemu_opt_set(opts, "backend", "vc", &error_abort);
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003344 if (*p == ':') {
Stefan Weil49aa4052013-09-30 23:04:49 +02003345 if (sscanf(p+1, "%7[0-9]x%7[0-9]", width, height) == 2) {
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003346 /* pixels */
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003347 qemu_opt_set(opts, "width", width, &error_abort);
3348 qemu_opt_set(opts, "height", height, &error_abort);
Stefan Weil49aa4052013-09-30 23:04:49 +02003349 } else if (sscanf(p+1, "%7[0-9]Cx%7[0-9]C", width, height) == 2) {
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003350 /* chars */
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003351 qemu_opt_set(opts, "cols", width, &error_abort);
3352 qemu_opt_set(opts, "rows", height, &error_abort);
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003353 } else {
3354 goto fail;
3355 }
3356 }
3357 return opts;
3358 }
Gerd Hoffmannd6c983c2009-09-10 10:58:47 +02003359 if (strcmp(filename, "con:") == 0) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003360 qemu_opt_set(opts, "backend", "console", &error_abort);
Gerd Hoffmannd6c983c2009-09-10 10:58:47 +02003361 return opts;
3362 }
Gerd Hoffmann48b76492009-09-10 10:58:48 +02003363 if (strstart(filename, "COM", NULL)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003364 qemu_opt_set(opts, "backend", "serial", &error_abort);
3365 qemu_opt_set(opts, "path", filename, &error_abort);
Gerd Hoffmann48b76492009-09-10 10:58:48 +02003366 return opts;
3367 }
Gerd Hoffmann7d315442009-09-10 10:58:36 +02003368 if (strstart(filename, "file:", &p)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003369 qemu_opt_set(opts, "backend", "file", &error_abort);
3370 qemu_opt_set(opts, "path", p, &error_abort);
Gerd Hoffmann7d315442009-09-10 10:58:36 +02003371 return opts;
3372 }
3373 if (strstart(filename, "pipe:", &p)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003374 qemu_opt_set(opts, "backend", "pipe", &error_abort);
3375 qemu_opt_set(opts, "path", p, &error_abort);
Gerd Hoffmann7d315442009-09-10 10:58:36 +02003376 return opts;
3377 }
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003378 if (strstart(filename, "tcp:", &p) ||
3379 strstart(filename, "telnet:", &p)) {
3380 if (sscanf(p, "%64[^:]:%32[^,]%n", host, port, &pos) < 2) {
3381 host[0] = 0;
3382 if (sscanf(p, ":%32[^,]%n", port, &pos) < 1)
3383 goto fail;
3384 }
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003385 qemu_opt_set(opts, "backend", "socket", &error_abort);
3386 qemu_opt_set(opts, "host", host, &error_abort);
3387 qemu_opt_set(opts, "port", port, &error_abort);
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003388 if (p[pos] == ',') {
Markus Armbrusterdc523cd342015-02-12 18:37:11 +01003389 qemu_opts_do_parse(opts, p+pos+1, NULL, &local_err);
3390 if (local_err) {
3391 error_report_err(local_err);
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003392 goto fail;
Markus Armbrusterdc523cd342015-02-12 18:37:11 +01003393 }
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003394 }
3395 if (strstart(filename, "telnet:", &p))
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003396 qemu_opt_set(opts, "telnet", "on", &error_abort);
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003397 return opts;
3398 }
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003399 if (strstart(filename, "udp:", &p)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003400 qemu_opt_set(opts, "backend", "udp", &error_abort);
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003401 if (sscanf(p, "%64[^:]:%32[^@,]%n", host, port, &pos) < 2) {
3402 host[0] = 0;
Jan Kiszka39324ca2010-03-07 11:28:48 +01003403 if (sscanf(p, ":%32[^@,]%n", port, &pos) < 1) {
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003404 goto fail;
3405 }
3406 }
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003407 qemu_opt_set(opts, "host", host, &error_abort);
3408 qemu_opt_set(opts, "port", port, &error_abort);
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003409 if (p[pos] == '@') {
3410 p += pos + 1;
3411 if (sscanf(p, "%64[^:]:%32[^,]%n", host, port, &pos) < 2) {
3412 host[0] = 0;
3413 if (sscanf(p, ":%32[^,]%n", port, &pos) < 1) {
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003414 goto fail;
3415 }
3416 }
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003417 qemu_opt_set(opts, "localaddr", host, &error_abort);
3418 qemu_opt_set(opts, "localport", port, &error_abort);
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003419 }
3420 return opts;
3421 }
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003422 if (strstart(filename, "unix:", &p)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003423 qemu_opt_set(opts, "backend", "socket", &error_abort);
Markus Armbrusterdc523cd342015-02-12 18:37:11 +01003424 qemu_opts_do_parse(opts, p, "path", &local_err);
3425 if (local_err) {
3426 error_report_err(local_err);
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003427 goto fail;
Markus Armbrusterdc523cd342015-02-12 18:37:11 +01003428 }
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003429 return opts;
3430 }
Gerd Hoffmann48b76492009-09-10 10:58:48 +02003431 if (strstart(filename, "/dev/parport", NULL) ||
3432 strstart(filename, "/dev/ppi", NULL)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003433 qemu_opt_set(opts, "backend", "parport", &error_abort);
3434 qemu_opt_set(opts, "path", filename, &error_abort);
Gerd Hoffmann48b76492009-09-10 10:58:48 +02003435 return opts;
3436 }
3437 if (strstart(filename, "/dev/", NULL)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003438 qemu_opt_set(opts, "backend", "tty", &error_abort);
3439 qemu_opt_set(opts, "path", filename, &error_abort);
Gerd Hoffmann48b76492009-09-10 10:58:48 +02003440 return opts;
3441 }
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003442
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003443fail:
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003444 qemu_opts_del(opts);
3445 return NULL;
3446}
3447
Gerd Hoffmann846e2e42013-02-21 12:07:14 +01003448static void qemu_chr_parse_file_out(QemuOpts *opts, ChardevBackend *backend,
3449 Error **errp)
3450{
3451 const char *path = qemu_opt_get(opts, "path");
3452
3453 if (path == NULL) {
3454 error_setg(errp, "chardev: file: no filename given");
3455 return;
3456 }
3457 backend->file = g_new0(ChardevFile, 1);
3458 backend->file->out = g_strdup(path);
3459}
3460
Gerd Hoffmann7c358032013-02-21 12:34:58 +01003461static void qemu_chr_parse_stdio(QemuOpts *opts, ChardevBackend *backend,
3462 Error **errp)
3463{
3464 backend->stdio = g_new0(ChardevStdio, 1);
3465 backend->stdio->has_signal = true;
Paolo Bonzini02c4bdf2013-07-03 20:29:45 +04003466 backend->stdio->signal = qemu_opt_get_bool(opts, "signal", true);
Gerd Hoffmann7c358032013-02-21 12:34:58 +01003467}
3468
Paolo Bonzini6511d392015-09-29 15:08:05 +02003469#ifdef HAVE_CHARDEV_SERIAL
Gerd Hoffmann0f1cb512013-02-22 15:48:05 +01003470static void qemu_chr_parse_serial(QemuOpts *opts, ChardevBackend *backend,
3471 Error **errp)
3472{
3473 const char *device = qemu_opt_get(opts, "path");
3474
3475 if (device == NULL) {
3476 error_setg(errp, "chardev: serial/tty: no device path given");
3477 return;
3478 }
3479 backend->serial = g_new0(ChardevHostdev, 1);
3480 backend->serial->device = g_strdup(device);
3481}
Paolo Bonzini6511d392015-09-29 15:08:05 +02003482#endif
Gerd Hoffmann0f1cb512013-02-22 15:48:05 +01003483
Gerd Hoffmanndc375092013-02-22 16:17:01 +01003484static void qemu_chr_parse_parallel(QemuOpts *opts, ChardevBackend *backend,
3485 Error **errp)
3486{
3487 const char *device = qemu_opt_get(opts, "path");
3488
3489 if (device == NULL) {
3490 error_setg(errp, "chardev: parallel: no device path given");
3491 return;
3492 }
3493 backend->parallel = g_new0(ChardevHostdev, 1);
3494 backend->parallel->device = g_strdup(device);
3495}
3496
Gerd Hoffmann548cbb32013-02-25 11:50:55 +01003497static void qemu_chr_parse_pipe(QemuOpts *opts, ChardevBackend *backend,
3498 Error **errp)
3499{
3500 const char *device = qemu_opt_get(opts, "path");
3501
3502 if (device == NULL) {
3503 error_setg(errp, "chardev: pipe: no device path given");
3504 return;
3505 }
3506 backend->pipe = g_new0(ChardevHostdev, 1);
3507 backend->pipe->device = g_strdup(device);
3508}
3509
Markus Armbruster4f573782013-07-26 16:44:32 +02003510static void qemu_chr_parse_ringbuf(QemuOpts *opts, ChardevBackend *backend,
3511 Error **errp)
Gerd Hoffmann1da48c62013-02-26 16:21:11 +01003512{
3513 int val;
3514
Markus Armbruster3a1da422013-07-26 16:44:34 +02003515 backend->ringbuf = g_new0(ChardevRingbuf, 1);
Gerd Hoffmann1da48c62013-02-26 16:21:11 +01003516
Markus Armbruster0f953052013-06-27 16:22:07 +02003517 val = qemu_opt_get_size(opts, "size", 0);
Gerd Hoffmann1da48c62013-02-26 16:21:11 +01003518 if (val != 0) {
Markus Armbruster3a1da422013-07-26 16:44:34 +02003519 backend->ringbuf->has_size = true;
3520 backend->ringbuf->size = val;
Gerd Hoffmann1da48c62013-02-26 16:21:11 +01003521 }
3522}
3523
Gerd Hoffmannbb6fb7c2013-06-24 08:39:54 +02003524static void qemu_chr_parse_mux(QemuOpts *opts, ChardevBackend *backend,
3525 Error **errp)
3526{
3527 const char *chardev = qemu_opt_get(opts, "chardev");
3528
3529 if (chardev == NULL) {
3530 error_setg(errp, "chardev: mux: no chardev given");
3531 return;
3532 }
3533 backend->mux = g_new0(ChardevMux, 1);
3534 backend->mux->chardev = g_strdup(chardev);
3535}
3536
Peter Maydelldafd3252014-09-02 11:24:13 +01003537static void qemu_chr_parse_socket(QemuOpts *opts, ChardevBackend *backend,
3538 Error **errp)
3539{
3540 bool is_listen = qemu_opt_get_bool(opts, "server", false);
3541 bool is_waitconnect = is_listen && qemu_opt_get_bool(opts, "wait", true);
3542 bool is_telnet = qemu_opt_get_bool(opts, "telnet", false);
3543 bool do_nodelay = !qemu_opt_get_bool(opts, "delay", true);
Corey Minyard5dd1f022014-10-02 11:17:37 -05003544 int64_t reconnect = qemu_opt_get_number(opts, "reconnect", 0);
Peter Maydelldafd3252014-09-02 11:24:13 +01003545 const char *path = qemu_opt_get(opts, "path");
3546 const char *host = qemu_opt_get(opts, "host");
3547 const char *port = qemu_opt_get(opts, "port");
3548 SocketAddress *addr;
3549
3550 if (!path) {
3551 if (!host) {
3552 error_setg(errp, "chardev: socket: no host given");
3553 return;
3554 }
3555 if (!port) {
3556 error_setg(errp, "chardev: socket: no port given");
3557 return;
3558 }
3559 }
3560
3561 backend->socket = g_new0(ChardevSocket, 1);
3562
3563 backend->socket->has_nodelay = true;
3564 backend->socket->nodelay = do_nodelay;
3565 backend->socket->has_server = true;
3566 backend->socket->server = is_listen;
3567 backend->socket->has_telnet = true;
3568 backend->socket->telnet = is_telnet;
3569 backend->socket->has_wait = true;
3570 backend->socket->wait = is_waitconnect;
Corey Minyard5dd1f022014-10-02 11:17:37 -05003571 backend->socket->has_reconnect = true;
3572 backend->socket->reconnect = reconnect;
Peter Maydelldafd3252014-09-02 11:24:13 +01003573
3574 addr = g_new0(SocketAddress, 1);
3575 if (path) {
3576 addr->kind = SOCKET_ADDRESS_KIND_UNIX;
3577 addr->q_unix = g_new0(UnixSocketAddress, 1);
3578 addr->q_unix->path = g_strdup(path);
3579 } else {
3580 addr->kind = SOCKET_ADDRESS_KIND_INET;
3581 addr->inet = g_new0(InetSocketAddress, 1);
3582 addr->inet->host = g_strdup(host);
3583 addr->inet->port = g_strdup(port);
3584 addr->inet->has_to = qemu_opt_get(opts, "to");
3585 addr->inet->to = qemu_opt_get_number(opts, "to", 0);
3586 addr->inet->has_ipv4 = qemu_opt_get(opts, "ipv4");
3587 addr->inet->ipv4 = qemu_opt_get_bool(opts, "ipv4", 0);
3588 addr->inet->has_ipv6 = qemu_opt_get(opts, "ipv6");
3589 addr->inet->ipv6 = qemu_opt_get_bool(opts, "ipv6", 0);
3590 }
3591 backend->socket->addr = addr;
3592}
3593
Peter Maydell90a14bf2014-09-02 11:24:15 +01003594static void qemu_chr_parse_udp(QemuOpts *opts, ChardevBackend *backend,
3595 Error **errp)
3596{
3597 const char *host = qemu_opt_get(opts, "host");
3598 const char *port = qemu_opt_get(opts, "port");
3599 const char *localaddr = qemu_opt_get(opts, "localaddr");
3600 const char *localport = qemu_opt_get(opts, "localport");
3601 bool has_local = false;
3602 SocketAddress *addr;
3603
3604 if (host == NULL || strlen(host) == 0) {
3605 host = "localhost";
3606 }
3607 if (port == NULL || strlen(port) == 0) {
3608 error_setg(errp, "chardev: udp: remote port not specified");
3609 return;
3610 }
3611 if (localport == NULL || strlen(localport) == 0) {
3612 localport = "0";
3613 } else {
3614 has_local = true;
3615 }
3616 if (localaddr == NULL || strlen(localaddr) == 0) {
3617 localaddr = "";
3618 } else {
3619 has_local = true;
3620 }
3621
3622 backend->udp = g_new0(ChardevUdp, 1);
3623
3624 addr = g_new0(SocketAddress, 1);
3625 addr->kind = SOCKET_ADDRESS_KIND_INET;
3626 addr->inet = g_new0(InetSocketAddress, 1);
3627 addr->inet->host = g_strdup(host);
3628 addr->inet->port = g_strdup(port);
3629 addr->inet->has_ipv4 = qemu_opt_get(opts, "ipv4");
3630 addr->inet->ipv4 = qemu_opt_get_bool(opts, "ipv4", 0);
3631 addr->inet->has_ipv6 = qemu_opt_get(opts, "ipv6");
3632 addr->inet->ipv6 = qemu_opt_get_bool(opts, "ipv6", 0);
3633 backend->udp->remote = addr;
3634
3635 if (has_local) {
3636 backend->udp->has_local = true;
3637 addr = g_new0(SocketAddress, 1);
3638 addr->kind = SOCKET_ADDRESS_KIND_INET;
3639 addr->inet = g_new0(InetSocketAddress, 1);
3640 addr->inet->host = g_strdup(localaddr);
3641 addr->inet->port = g_strdup(localport);
3642 backend->udp->local = addr;
3643 }
3644}
3645
Anthony Liguorid654f342013-03-05 23:21:28 +05303646typedef struct CharDriver {
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003647 const char *name;
Gerd Hoffmann99aec012013-06-24 08:39:52 +02003648 ChardevBackendKind kind;
Gerd Hoffmann2c5f4882013-02-21 11:39:12 +01003649 void (*parse)(QemuOpts *opts, ChardevBackend *backend, Error **errp);
Paolo Bonzini4ca17282015-09-29 14:55:59 +02003650 CharDriverState *(*create)(const char *id, ChardevBackend *backend,
3651 ChardevReturn *ret, Error **errp);
Anthony Liguorid654f342013-03-05 23:21:28 +05303652} CharDriver;
3653
3654static GSList *backends;
3655
Peter Maydelle4d50d42014-09-02 11:24:17 +01003656void register_char_driver(const char *name, ChardevBackendKind kind,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02003657 void (*parse)(QemuOpts *opts, ChardevBackend *backend, Error **errp),
3658 CharDriverState *(*create)(const char *id, ChardevBackend *backend,
3659 ChardevReturn *ret, Error **errp))
Gerd Hoffmann2c5f4882013-02-21 11:39:12 +01003660{
3661 CharDriver *s;
3662
3663 s = g_malloc0(sizeof(*s));
3664 s->name = g_strdup(name);
3665 s->kind = kind;
3666 s->parse = parse;
Paolo Bonzini4ca17282015-09-29 14:55:59 +02003667 s->create = create;
Gerd Hoffmann2c5f4882013-02-21 11:39:12 +01003668
3669 backends = g_slist_append(backends, s);
3670}
3671
Anthony Liguorif69554b2011-08-15 11:17:37 -05003672CharDriverState *qemu_chr_new_from_opts(QemuOpts *opts,
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003673 void (*init)(struct CharDriverState *s),
3674 Error **errp)
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003675{
Markus Armbruster0aff6372014-05-19 18:57:35 +02003676 Error *local_err = NULL;
Anthony Liguorid654f342013-03-05 23:21:28 +05303677 CharDriver *cd;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003678 CharDriverState *chr;
Anthony Liguorid654f342013-03-05 23:21:28 +05303679 GSList *i;
Peter Maydella61ae7f2014-09-02 11:24:16 +01003680 ChardevReturn *ret = NULL;
3681 ChardevBackend *backend;
3682 const char *id = qemu_opts_id(opts);
3683 char *bid = NULL;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003684
Peter Maydella61ae7f2014-09-02 11:24:16 +01003685 if (id == NULL) {
Markus Armbruster312fd5f2013-02-08 21:22:16 +01003686 error_setg(errp, "chardev: no id specified");
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003687 goto err;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003688 }
3689
Stefan Hajnoczi1bbd1852011-01-22 13:07:26 +00003690 if (qemu_opt_get(opts, "backend") == NULL) {
Markus Armbruster312fd5f2013-02-08 21:22:16 +01003691 error_setg(errp, "chardev: \"%s\" missing backend",
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003692 qemu_opts_id(opts));
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003693 goto err;
Stefan Hajnoczi1bbd1852011-01-22 13:07:26 +00003694 }
Anthony Liguorid654f342013-03-05 23:21:28 +05303695 for (i = backends; i; i = i->next) {
3696 cd = i->data;
3697
3698 if (strcmp(cd->name, qemu_opt_get(opts, "backend")) == 0) {
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003699 break;
Anthony Liguorid654f342013-03-05 23:21:28 +05303700 }
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003701 }
Anthony Liguorid654f342013-03-05 23:21:28 +05303702 if (i == NULL) {
Markus Armbruster312fd5f2013-02-08 21:22:16 +01003703 error_setg(errp, "chardev: backend \"%s\" not found",
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003704 qemu_opt_get(opts, "backend"));
Gerd Hoffmanne6682872013-06-24 08:39:51 +02003705 goto err;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003706 }
3707
Peter Maydella61ae7f2014-09-02 11:24:16 +01003708 backend = g_new0(ChardevBackend, 1);
Gerd Hoffmann7591c5c2009-09-10 10:58:50 +02003709
3710 if (qemu_opt_get_bool(opts, "mux", 0)) {
Peter Maydella61ae7f2014-09-02 11:24:16 +01003711 bid = g_strdup_printf("%s-base", id);
Gerd Hoffmann7591c5c2009-09-10 10:58:50 +02003712 }
Peter Maydella61ae7f2014-09-02 11:24:16 +01003713
3714 chr = NULL;
3715 backend->kind = cd->kind;
3716 if (cd->parse) {
3717 cd->parse(opts, backend, &local_err);
3718 if (local_err) {
3719 error_propagate(errp, local_err);
3720 goto qapi_out;
3721 }
3722 }
3723 ret = qmp_chardev_add(bid ? bid : id, backend, errp);
3724 if (!ret) {
3725 goto qapi_out;
3726 }
3727
3728 if (bid) {
3729 qapi_free_ChardevBackend(backend);
3730 qapi_free_ChardevReturn(ret);
3731 backend = g_new0(ChardevBackend, 1);
3732 backend->mux = g_new0(ChardevMux, 1);
3733 backend->kind = CHARDEV_BACKEND_KIND_MUX;
3734 backend->mux->chardev = g_strdup(bid);
3735 ret = qmp_chardev_add(id, backend, errp);
3736 if (!ret) {
3737 chr = qemu_chr_find(bid);
3738 qemu_chr_delete(chr);
3739 chr = NULL;
3740 goto qapi_out;
3741 }
3742 }
3743
3744 chr = qemu_chr_find(id);
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003745 chr->opts = opts;
Peter Maydella61ae7f2014-09-02 11:24:16 +01003746
3747qapi_out:
3748 qapi_free_ChardevBackend(backend);
3749 qapi_free_ChardevReturn(ret);
3750 g_free(bid);
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003751 return chr;
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003752
3753err:
3754 qemu_opts_del(opts);
3755 return NULL;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003756}
3757
Anthony Liguori27143a42011-08-15 11:17:36 -05003758CharDriverState *qemu_chr_new(const char *label, const char *filename, void (*init)(struct CharDriverState *s))
aliguori6f97dba2008-10-31 18:49:55 +00003759{
3760 const char *p;
3761 CharDriverState *chr;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003762 QemuOpts *opts;
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003763 Error *err = NULL;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003764
Gerd Hoffmannc845f402009-09-10 10:58:52 +02003765 if (strstart(filename, "chardev:", &p)) {
3766 return qemu_chr_find(p);
3767 }
3768
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003769 opts = qemu_chr_parse_compat(label, filename);
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003770 if (!opts)
3771 return NULL;
aliguori6f97dba2008-10-31 18:49:55 +00003772
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003773 chr = qemu_chr_new_from_opts(opts, init, &err);
Markus Armbruster84d18f02014-01-30 15:07:28 +01003774 if (err) {
Markus Armbruster565f65d2015-02-12 13:55:05 +01003775 error_report_err(err);
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003776 }
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003777 if (chr && qemu_opt_get_bool(opts, "mux", 0)) {
Hans de Goede456d6062013-03-27 20:29:40 +01003778 qemu_chr_fe_claim_no_fail(chr);
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003779 monitor_init(chr, MONITOR_USE_READLINE);
aliguori6f97dba2008-10-31 18:49:55 +00003780 }
3781 return chr;
3782}
3783
Anthony Liguori15f31512011-08-15 11:17:35 -05003784void qemu_chr_fe_set_echo(struct CharDriverState *chr, bool echo)
Paolo Bonzinic48855e2010-12-23 13:42:48 +01003785{
3786 if (chr->chr_set_echo) {
3787 chr->chr_set_echo(chr, echo);
3788 }
3789}
3790
Hans de Goede8e25daa2013-03-26 11:07:57 +01003791void qemu_chr_fe_set_open(struct CharDriverState *chr, int fe_open)
Hans de Goede7c32c4f2011-03-24 11:12:02 +01003792{
Hans de Goede8e25daa2013-03-26 11:07:57 +01003793 if (chr->fe_open == fe_open) {
Hans de Goedec0c4bd22013-03-26 11:07:55 +01003794 return;
3795 }
Hans de Goede8e25daa2013-03-26 11:07:57 +01003796 chr->fe_open = fe_open;
Hans de Goede574b7112013-03-26 11:07:58 +01003797 if (chr->chr_set_fe_open) {
3798 chr->chr_set_fe_open(chr, fe_open);
Hans de Goede7c32c4f2011-03-24 11:12:02 +01003799 }
3800}
3801
Marc-André Lureaud61b0c92013-12-01 22:23:39 +01003802void qemu_chr_fe_event(struct CharDriverState *chr, int event)
3803{
3804 if (chr->chr_fe_event) {
3805 chr->chr_fe_event(chr, event);
3806 }
3807}
3808
Kevin Wolf2c8a5942013-03-19 13:38:09 +01003809int qemu_chr_fe_add_watch(CharDriverState *s, GIOCondition cond,
3810 GIOFunc func, void *user_data)
Anthony Liguori23673ca2013-03-05 23:21:23 +05303811{
3812 GSource *src;
3813 guint tag;
3814
3815 if (s->chr_add_watch == NULL) {
3816 return -ENOSYS;
3817 }
3818
3819 src = s->chr_add_watch(s, cond);
Paolo Bonzini62c339c2014-07-24 16:08:04 +02003820 if (!src) {
3821 return -EINVAL;
3822 }
3823
Anthony Liguori23673ca2013-03-05 23:21:23 +05303824 g_source_set_callback(src, (GSourceFunc)func, user_data, NULL);
3825 tag = g_source_attach(src, NULL);
3826 g_source_unref(src);
3827
3828 return tag;
3829}
3830
Hans de Goede44c473d2013-03-27 20:29:39 +01003831int qemu_chr_fe_claim(CharDriverState *s)
3832{
3833 if (s->avail_connections < 1) {
3834 return -1;
3835 }
3836 s->avail_connections--;
3837 return 0;
3838}
3839
3840void qemu_chr_fe_claim_no_fail(CharDriverState *s)
3841{
3842 if (qemu_chr_fe_claim(s) != 0) {
3843 fprintf(stderr, "%s: error chardev \"%s\" already used\n",
3844 __func__, s->label);
3845 exit(1);
3846 }
3847}
3848
3849void qemu_chr_fe_release(CharDriverState *s)
3850{
3851 s->avail_connections++;
3852}
3853
Anthony Liguori70f24fb2011-08-15 11:17:38 -05003854void qemu_chr_delete(CharDriverState *chr)
aliguori6f97dba2008-10-31 18:49:55 +00003855{
Blue Swirl72cf2d42009-09-12 07:36:22 +00003856 QTAILQ_REMOVE(&chardevs, chr, next);
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003857 if (chr->chr_close) {
aliguori6f97dba2008-10-31 18:49:55 +00003858 chr->chr_close(chr);
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003859 }
Anthony Liguori7267c092011-08-20 22:09:37 -05003860 g_free(chr->filename);
3861 g_free(chr->label);
Markus Armbruster4ad60882014-12-03 11:28:02 +01003862 qemu_opts_del(chr->opts);
Anthony Liguori7267c092011-08-20 22:09:37 -05003863 g_free(chr);
aliguori6f97dba2008-10-31 18:49:55 +00003864}
3865
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -03003866ChardevInfoList *qmp_query_chardev(Error **errp)
aliguori6f97dba2008-10-31 18:49:55 +00003867{
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -03003868 ChardevInfoList *chr_list = NULL;
aliguori6f97dba2008-10-31 18:49:55 +00003869 CharDriverState *chr;
3870
Blue Swirl72cf2d42009-09-12 07:36:22 +00003871 QTAILQ_FOREACH(chr, &chardevs, next) {
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -03003872 ChardevInfoList *info = g_malloc0(sizeof(*info));
3873 info->value = g_malloc0(sizeof(*info->value));
3874 info->value->label = g_strdup(chr->label);
3875 info->value->filename = g_strdup(chr->filename);
Laszlo Ersek32a97ea2014-06-26 17:50:03 +02003876 info->value->frontend_open = chr->fe_open;
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -03003877
3878 info->next = chr_list;
3879 chr_list = info;
aliguori6f97dba2008-10-31 18:49:55 +00003880 }
Luiz Capitulino588b3832009-12-10 17:16:08 -02003881
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -03003882 return chr_list;
aliguori6f97dba2008-10-31 18:49:55 +00003883}
Gerd Hoffmannc845f402009-09-10 10:58:52 +02003884
Martin Kletzander77d1c3c2014-02-01 12:52:42 +01003885ChardevBackendInfoList *qmp_query_chardev_backends(Error **errp)
3886{
3887 ChardevBackendInfoList *backend_list = NULL;
3888 CharDriver *c = NULL;
3889 GSList *i = NULL;
3890
3891 for (i = backends; i; i = i->next) {
3892 ChardevBackendInfoList *info = g_malloc0(sizeof(*info));
3893 c = i->data;
3894 info->value = g_malloc0(sizeof(*info->value));
3895 info->value->name = g_strdup(c->name);
3896
3897 info->next = backend_list;
3898 backend_list = info;
3899 }
3900
3901 return backend_list;
3902}
3903
Gerd Hoffmannc845f402009-09-10 10:58:52 +02003904CharDriverState *qemu_chr_find(const char *name)
3905{
3906 CharDriverState *chr;
3907
Blue Swirl72cf2d42009-09-12 07:36:22 +00003908 QTAILQ_FOREACH(chr, &chardevs, next) {
Gerd Hoffmannc845f402009-09-10 10:58:52 +02003909 if (strcmp(chr->label, name) != 0)
3910 continue;
3911 return chr;
3912 }
3913 return NULL;
3914}
Anthony Liguori0beb4942011-12-22 15:29:25 -06003915
3916/* Get a character (serial) device interface. */
3917CharDriverState *qemu_char_get_next_serial(void)
3918{
3919 static int next_serial;
Hans de Goede456d6062013-03-27 20:29:40 +01003920 CharDriverState *chr;
Anthony Liguori0beb4942011-12-22 15:29:25 -06003921
3922 /* FIXME: This function needs to go away: use chardev properties! */
Hans de Goede456d6062013-03-27 20:29:40 +01003923
3924 while (next_serial < MAX_SERIAL_PORTS && serial_hds[next_serial]) {
3925 chr = serial_hds[next_serial++];
3926 qemu_chr_fe_claim_no_fail(chr);
3927 return chr;
3928 }
3929 return NULL;
Anthony Liguori0beb4942011-12-22 15:29:25 -06003930}
3931
Paolo Bonzini4d454572012-11-26 16:03:42 +01003932QemuOptsList qemu_chardev_opts = {
3933 .name = "chardev",
3934 .implied_opt_name = "backend",
3935 .head = QTAILQ_HEAD_INITIALIZER(qemu_chardev_opts.head),
3936 .desc = {
3937 {
3938 .name = "backend",
3939 .type = QEMU_OPT_STRING,
3940 },{
3941 .name = "path",
3942 .type = QEMU_OPT_STRING,
3943 },{
3944 .name = "host",
3945 .type = QEMU_OPT_STRING,
3946 },{
3947 .name = "port",
3948 .type = QEMU_OPT_STRING,
3949 },{
3950 .name = "localaddr",
3951 .type = QEMU_OPT_STRING,
3952 },{
3953 .name = "localport",
3954 .type = QEMU_OPT_STRING,
3955 },{
3956 .name = "to",
3957 .type = QEMU_OPT_NUMBER,
3958 },{
3959 .name = "ipv4",
3960 .type = QEMU_OPT_BOOL,
3961 },{
3962 .name = "ipv6",
3963 .type = QEMU_OPT_BOOL,
3964 },{
3965 .name = "wait",
3966 .type = QEMU_OPT_BOOL,
3967 },{
3968 .name = "server",
3969 .type = QEMU_OPT_BOOL,
3970 },{
3971 .name = "delay",
3972 .type = QEMU_OPT_BOOL,
3973 },{
Corey Minyard5dd1f022014-10-02 11:17:37 -05003974 .name = "reconnect",
3975 .type = QEMU_OPT_NUMBER,
3976 },{
Paolo Bonzini4d454572012-11-26 16:03:42 +01003977 .name = "telnet",
3978 .type = QEMU_OPT_BOOL,
3979 },{
3980 .name = "width",
3981 .type = QEMU_OPT_NUMBER,
3982 },{
3983 .name = "height",
3984 .type = QEMU_OPT_NUMBER,
3985 },{
3986 .name = "cols",
3987 .type = QEMU_OPT_NUMBER,
3988 },{
3989 .name = "rows",
3990 .type = QEMU_OPT_NUMBER,
3991 },{
3992 .name = "mux",
3993 .type = QEMU_OPT_BOOL,
3994 },{
3995 .name = "signal",
3996 .type = QEMU_OPT_BOOL,
3997 },{
3998 .name = "name",
3999 .type = QEMU_OPT_STRING,
4000 },{
4001 .name = "debug",
4002 .type = QEMU_OPT_NUMBER,
Lei Li51767e72013-01-25 00:03:19 +08004003 },{
Markus Armbruster3949e592013-02-06 21:27:24 +01004004 .name = "size",
Markus Armbrusterde1cc362013-02-06 21:27:25 +01004005 .type = QEMU_OPT_SIZE,
Gerd Hoffmannbb6fb7c2013-06-24 08:39:54 +02004006 },{
4007 .name = "chardev",
4008 .type = QEMU_OPT_STRING,
Paolo Bonzini4d454572012-11-26 16:03:42 +01004009 },
4010 { /* end of list */ }
4011 },
4012};
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004013
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004014#ifdef _WIN32
4015
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004016static CharDriverState *qmp_chardev_open_file(const char *id,
4017 ChardevBackend *backend,
4018 ChardevReturn *ret,
4019 Error **errp)
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004020{
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004021 ChardevFile *file = backend->file;
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004022 HANDLE out;
4023
Gerd Hoffmanne859eda2013-06-24 08:39:47 +02004024 if (file->has_in) {
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004025 error_setg(errp, "input file not supported");
4026 return NULL;
4027 }
4028
4029 out = CreateFile(file->out, GENERIC_WRITE, FILE_SHARE_READ, NULL,
4030 OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL, NULL);
4031 if (out == INVALID_HANDLE_VALUE) {
4032 error_setg(errp, "open %s failed", file->out);
4033 return NULL;
4034 }
4035 return qemu_chr_open_win_file(out);
4036}
4037
Paolo Bonzini6511d392015-09-29 15:08:05 +02004038static CharDriverState *qmp_chardev_open_serial(const char *id,
4039 ChardevBackend *backend,
4040 ChardevReturn *ret,
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004041 Error **errp)
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004042{
Paolo Bonzini6511d392015-09-29 15:08:05 +02004043 ChardevHostdev *serial = backend->serial;
4044 return qemu_chr_open_win_path(serial->device, errp);
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004045}
4046
4047static CharDriverState *qmp_chardev_open_parallel(ChardevHostdev *parallel,
4048 Error **errp)
4049{
4050 error_setg(errp, "character device backend type 'parallel' not supported");
4051 return NULL;
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004052}
4053
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004054#else /* WIN32 */
4055
4056static int qmp_chardev_open_file_source(char *src, int flags,
4057 Error **errp)
4058{
4059 int fd = -1;
4060
4061 TFR(fd = qemu_open(src, flags, 0666));
4062 if (fd == -1) {
Gerd Hoffmann20c39762013-06-24 08:39:48 +02004063 error_setg_file_open(errp, errno, src);
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004064 }
4065 return fd;
4066}
4067
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004068static CharDriverState *qmp_chardev_open_file(const char *id,
4069 ChardevBackend *backend,
4070 ChardevReturn *ret,
4071 Error **errp)
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004072{
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004073 ChardevFile *file = backend->file;
Markus Armbruster5f758362014-05-19 18:57:34 +02004074 int flags, in = -1, out;
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004075
4076 flags = O_WRONLY | O_TRUNC | O_CREAT | O_BINARY;
4077 out = qmp_chardev_open_file_source(file->out, flags, errp);
Markus Armbruster5f758362014-05-19 18:57:34 +02004078 if (out < 0) {
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004079 return NULL;
4080 }
4081
Gerd Hoffmanne859eda2013-06-24 08:39:47 +02004082 if (file->has_in) {
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004083 flags = O_RDONLY;
4084 in = qmp_chardev_open_file_source(file->in, flags, errp);
Markus Armbruster5f758362014-05-19 18:57:34 +02004085 if (in < 0) {
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004086 qemu_close(out);
4087 return NULL;
4088 }
4089 }
4090
4091 return qemu_chr_open_fd(in, out);
4092}
4093
Paolo Bonzinid809ab92015-10-12 09:46:23 +02004094#ifdef HAVE_CHARDEV_SERIAL
Paolo Bonzini6511d392015-09-29 15:08:05 +02004095static CharDriverState *qmp_chardev_open_serial(const char *id,
4096 ChardevBackend *backend,
4097 ChardevReturn *ret,
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004098 Error **errp)
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004099{
Paolo Bonzini6511d392015-09-29 15:08:05 +02004100 ChardevHostdev *serial = backend->serial;
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004101 int fd;
4102
4103 fd = qmp_chardev_open_file_source(serial->device, O_RDWR, errp);
Markus Armbruster5f758362014-05-19 18:57:34 +02004104 if (fd < 0) {
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004105 return NULL;
4106 }
Stefan Hajnoczif9e8cac2013-03-27 10:10:43 +01004107 qemu_set_nonblock(fd);
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004108 return qemu_chr_open_tty_fd(fd);
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004109}
Paolo Bonzini6511d392015-09-29 15:08:05 +02004110#endif
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004111
Paolo Bonzinid809ab92015-10-12 09:46:23 +02004112#ifdef HAVE_CHARDEV_PARPORT
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004113static CharDriverState *qmp_chardev_open_parallel(ChardevHostdev *parallel,
4114 Error **errp)
4115{
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004116 int fd;
4117
4118 fd = qmp_chardev_open_file_source(parallel->device, O_RDWR, errp);
Markus Armbruster5f758362014-05-19 18:57:34 +02004119 if (fd < 0) {
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004120 return NULL;
4121 }
4122 return qemu_chr_open_pp_fd(fd);
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004123}
Paolo Bonzinid809ab92015-10-12 09:46:23 +02004124#endif
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004125
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004126#endif /* WIN32 */
4127
Corey Minyard5008e5b2014-10-08 07:11:55 -05004128static void socket_try_connect(CharDriverState *chr)
4129{
4130 Error *err = NULL;
4131
4132 if (!qemu_chr_open_socket_fd(chr, &err)) {
4133 check_report_connect_error(chr, err);
4134 }
4135}
4136
Corey Minyard5dd1f022014-10-02 11:17:37 -05004137static gboolean socket_reconnect_timeout(gpointer opaque)
4138{
4139 CharDriverState *chr = opaque;
4140 TCPCharDriver *s = chr->opaque;
Corey Minyard5dd1f022014-10-02 11:17:37 -05004141
4142 s->reconnect_timer = 0;
4143
4144 if (chr->be_open) {
4145 return false;
4146 }
4147
Corey Minyard5008e5b2014-10-08 07:11:55 -05004148 socket_try_connect(chr);
Corey Minyard5dd1f022014-10-02 11:17:37 -05004149
4150 return false;
4151}
4152
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004153static CharDriverState *qmp_chardev_open_socket(ChardevSocket *sock,
4154 Error **errp)
4155{
Corey Minyard43ded1a2014-10-02 11:17:34 -05004156 CharDriverState *chr;
4157 TCPCharDriver *s;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004158 SocketAddress *addr = sock->addr;
4159 bool do_nodelay = sock->has_nodelay ? sock->nodelay : false;
4160 bool is_listen = sock->has_server ? sock->server : true;
4161 bool is_telnet = sock->has_telnet ? sock->telnet : false;
4162 bool is_waitconnect = sock->has_wait ? sock->wait : false;
Corey Minyard5dd1f022014-10-02 11:17:37 -05004163 int64_t reconnect = sock->has_reconnect ? sock->reconnect : 0;
Corey Minyard43ded1a2014-10-02 11:17:34 -05004164
4165 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02004166 s = g_new0(TCPCharDriver, 1);
Corey Minyard43ded1a2014-10-02 11:17:34 -05004167
4168 s->fd = -1;
4169 s->listen_fd = -1;
4170 s->is_unix = addr->kind == SOCKET_ADDRESS_KIND_UNIX;
Corey Minyardcfb429c2014-10-02 11:17:35 -05004171 s->is_listen = is_listen;
4172 s->is_telnet = is_telnet;
Corey Minyard43ded1a2014-10-02 11:17:34 -05004173 s->do_nodelay = do_nodelay;
Corey Minyardcfb429c2014-10-02 11:17:35 -05004174 qapi_copy_SocketAddress(&s->addr, sock->addr);
Corey Minyard43ded1a2014-10-02 11:17:34 -05004175
4176 chr->opaque = s;
4177 chr->chr_write = tcp_chr_write;
4178 chr->chr_sync_read = tcp_chr_sync_read;
4179 chr->chr_close = tcp_chr_close;
4180 chr->get_msgfds = tcp_get_msgfds;
4181 chr->set_msgfds = tcp_set_msgfds;
4182 chr->chr_add_client = tcp_chr_add_client;
4183 chr->chr_add_watch = tcp_chr_add_watch;
4184 chr->chr_update_read_handler = tcp_chr_update_read_handler;
4185 /* be isn't opened until we get a connection */
4186 chr->explicit_be_open = true;
4187
4188 chr->filename = g_malloc(CHR_MAX_FILENAME_SIZE);
Corey Minyard16cc4ff2014-10-02 11:17:36 -05004189 SocketAddress_to_str(chr->filename, CHR_MAX_FILENAME_SIZE, "disconnected:",
4190 addr, is_listen, is_telnet);
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004191
4192 if (is_listen) {
Corey Minyard43ded1a2014-10-02 11:17:34 -05004193 if (is_telnet) {
4194 s->do_telnetopt = 1;
4195 }
Corey Minyard5dd1f022014-10-02 11:17:37 -05004196 } else if (reconnect > 0) {
4197 s->reconnect_time = reconnect;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004198 }
Corey Minyard43ded1a2014-10-02 11:17:34 -05004199
Corey Minyard5008e5b2014-10-08 07:11:55 -05004200 if (s->reconnect_time) {
4201 socket_try_connect(chr);
4202 } else if (!qemu_chr_open_socket_fd(chr, errp)) {
4203 g_free(s);
4204 g_free(chr->filename);
4205 g_free(chr);
4206 return NULL;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004207 }
Corey Minyard43ded1a2014-10-02 11:17:34 -05004208
4209 if (is_listen && is_waitconnect) {
4210 fprintf(stderr, "QEMU waiting for connection on: %s\n",
4211 chr->filename);
4212 tcp_chr_accept(s->listen_chan, G_IO_IN, chr);
4213 qemu_set_nonblock(s->listen_fd);
4214 }
4215
4216 return chr;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004217}
4218
Lei Li08d0ab32013-05-20 14:51:03 +08004219static CharDriverState *qmp_chardev_open_udp(ChardevUdp *udp,
4220 Error **errp)
Gerd Hoffmann3ecc0592013-02-27 14:10:47 +01004221{
4222 int fd;
4223
Lei Li08d0ab32013-05-20 14:51:03 +08004224 fd = socket_dgram(udp->remote, udp->local, errp);
Markus Armbruster5f758362014-05-19 18:57:34 +02004225 if (fd < 0) {
Gerd Hoffmann3ecc0592013-02-27 14:10:47 +01004226 return NULL;
4227 }
4228 return qemu_chr_open_udp_fd(fd);
4229}
4230
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004231ChardevReturn *qmp_chardev_add(const char *id, ChardevBackend *backend,
4232 Error **errp)
4233{
4234 ChardevReturn *ret = g_new0(ChardevReturn, 1);
Gerd Hoffmannedb2fb32013-02-21 16:16:42 +01004235 CharDriverState *base, *chr = NULL;
Paolo Bonzinieaeba652015-09-29 14:54:05 +02004236 Error *local_err = NULL;
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004237 GSList *i;
4238 CharDriver *cd;
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004239
4240 chr = qemu_chr_find(id);
4241 if (chr) {
4242 error_setg(errp, "Chardev '%s' already exists", id);
4243 g_free(ret);
4244 return NULL;
4245 }
4246
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004247 for (i = backends; i; i = i->next) {
4248 cd = i->data;
4249
4250 if (cd->kind == backend->kind && cd->create) {
4251 chr = cd->create(id, backend, ret, &local_err);
4252 if (local_err) {
4253 error_propagate(errp, local_err);
4254 goto out_error;
4255 }
Gerd Hoffmannedb2fb32013-02-21 16:16:42 +01004256 break;
4257 }
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004258 }
4259
Paolo Bonzinieaeba652015-09-29 14:54:05 +02004260 if (chr == NULL) {
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004261 switch (backend->kind) {
4262 case CHARDEV_BACKEND_KIND_FILE:
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004263 abort();
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004264 break;
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004265 case CHARDEV_BACKEND_KIND_SERIAL:
Paolo Bonzini6511d392015-09-29 15:08:05 +02004266 abort();
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004267 break;
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004268#ifdef HAVE_CHARDEV_PARPORT
4269 case CHARDEV_BACKEND_KIND_PARALLEL:
4270 chr = qmp_chardev_open_parallel(backend->parallel, &local_err);
4271 break;
4272#endif
4273 case CHARDEV_BACKEND_KIND_PIPE:
4274 chr = qemu_chr_open_pipe(backend->pipe);
4275 break;
4276 case CHARDEV_BACKEND_KIND_SOCKET:
4277 chr = qmp_chardev_open_socket(backend->socket, &local_err);
4278 break;
4279 case CHARDEV_BACKEND_KIND_UDP:
4280 chr = qmp_chardev_open_udp(backend->udp, &local_err);
4281 break;
4282#ifdef HAVE_CHARDEV_PTY
4283 case CHARDEV_BACKEND_KIND_PTY:
4284 chr = qemu_chr_open_pty(id, ret);
4285 break;
4286#endif
4287 case CHARDEV_BACKEND_KIND_NULL:
4288 chr = qemu_chr_open_null();
4289 break;
4290 case CHARDEV_BACKEND_KIND_MUX:
4291 base = qemu_chr_find(backend->mux->chardev);
4292 if (base == NULL) {
4293 error_setg(&local_err, "mux: base chardev %s not found",
4294 backend->mux->chardev);
4295 break;
4296 }
4297 chr = qemu_chr_open_mux(base);
4298 break;
4299 case CHARDEV_BACKEND_KIND_MSMOUSE:
4300 chr = qemu_chr_open_msmouse();
4301 break;
4302#ifdef CONFIG_BRLAPI
4303 case CHARDEV_BACKEND_KIND_BRAILLE:
4304 chr = chr_baum_init();
4305 break;
4306#endif
4307 case CHARDEV_BACKEND_KIND_TESTDEV:
4308 chr = chr_testdev_init();
4309 break;
4310 case CHARDEV_BACKEND_KIND_STDIO:
4311 chr = qemu_chr_open_stdio(backend->stdio);
4312 break;
4313#ifdef _WIN32
4314 case CHARDEV_BACKEND_KIND_CONSOLE:
4315 chr = qemu_chr_open_win_con();
4316 break;
4317#endif
4318#ifdef CONFIG_SPICE
4319 case CHARDEV_BACKEND_KIND_SPICEVMC:
4320 chr = qemu_chr_open_spice_vmc(backend->spicevmc->type);
4321 break;
4322 case CHARDEV_BACKEND_KIND_SPICEPORT:
4323 chr = qemu_chr_open_spice_port(backend->spiceport->fqdn);
4324 break;
4325#endif
4326 case CHARDEV_BACKEND_KIND_VC:
4327 chr = vc_init(backend->vc);
4328 break;
4329 case CHARDEV_BACKEND_KIND_RINGBUF:
4330 case CHARDEV_BACKEND_KIND_MEMORY:
4331 chr = qemu_chr_open_ringbuf(backend->ringbuf, &local_err);
4332 break;
4333 default:
4334 error_setg(errp, "unknown chardev backend (%d)", backend->kind);
4335 goto out_error;
Gerd Hoffmann60d95382013-05-27 12:41:24 +02004336 }
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004337
4338 /*
4339 * Character backend open hasn't been fully converted to the Error
4340 * API. Some opens fail without setting an error. Set a generic
4341 * error then.
4342 * TODO full conversion to Error API
4343 */
4344 if (chr == NULL) {
4345 if (local_err) {
4346 error_propagate(errp, local_err);
4347 } else {
4348 error_setg(errp, "Failed to create chardev");
4349 }
4350 goto out_error;
4351 }
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004352 }
Paolo Bonzinieaeba652015-09-29 14:54:05 +02004353
4354 chr->label = g_strdup(id);
4355 chr->avail_connections =
4356 (backend->kind == CHARDEV_BACKEND_KIND_MUX) ? MAX_MUX : 1;
4357 if (!chr->filename) {
4358 chr->filename = g_strdup(ChardevBackendKind_lookup[backend->kind]);
4359 }
4360 if (!chr->explicit_be_open) {
4361 qemu_chr_be_event(chr, CHR_EVENT_OPENED);
4362 }
4363 QTAILQ_INSERT_TAIL(&chardevs, chr, next);
4364 return ret;
4365
4366out_error:
4367 g_free(ret);
4368 return NULL;
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004369}
4370
4371void qmp_chardev_remove(const char *id, Error **errp)
4372{
4373 CharDriverState *chr;
4374
4375 chr = qemu_chr_find(id);
Gonglei8108fd32014-08-11 21:00:55 +08004376 if (chr == NULL) {
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004377 error_setg(errp, "Chardev '%s' not found", id);
4378 return;
4379 }
4380 if (chr->chr_can_read || chr->chr_read ||
4381 chr->chr_event || chr->handler_opaque) {
4382 error_setg(errp, "Chardev '%s' is busy", id);
4383 return;
4384 }
4385 qemu_chr_delete(chr);
4386}
Anthony Liguorid654f342013-03-05 23:21:28 +05304387
4388static void register_types(void)
4389{
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004390 register_char_driver("null", CHARDEV_BACKEND_KIND_NULL, NULL,
4391 NULL);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004392 register_char_driver("socket", CHARDEV_BACKEND_KIND_SOCKET,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004393 qemu_chr_parse_socket, NULL);
4394 register_char_driver("udp", CHARDEV_BACKEND_KIND_UDP, qemu_chr_parse_udp,
4395 NULL);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004396 register_char_driver("ringbuf", CHARDEV_BACKEND_KIND_RINGBUF,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004397 qemu_chr_parse_ringbuf, NULL);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004398 register_char_driver("file", CHARDEV_BACKEND_KIND_FILE,
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004399 qemu_chr_parse_file_out, qmp_chardev_open_file);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004400 register_char_driver("stdio", CHARDEV_BACKEND_KIND_STDIO,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004401 qemu_chr_parse_stdio, NULL);
Paolo Bonzini6511d392015-09-29 15:08:05 +02004402#if defined HAVE_CHARDEV_SERIAL
Peter Maydelle4d50d42014-09-02 11:24:17 +01004403 register_char_driver("serial", CHARDEV_BACKEND_KIND_SERIAL,
Paolo Bonzini6511d392015-09-29 15:08:05 +02004404 qemu_chr_parse_serial, qmp_chardev_open_serial);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004405 register_char_driver("tty", CHARDEV_BACKEND_KIND_SERIAL,
Paolo Bonzini6511d392015-09-29 15:08:05 +02004406 qemu_chr_parse_serial, qmp_chardev_open_serial);
4407#endif
Peter Maydelle4d50d42014-09-02 11:24:17 +01004408 register_char_driver("parallel", CHARDEV_BACKEND_KIND_PARALLEL,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004409 qemu_chr_parse_parallel, NULL);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004410 register_char_driver("parport", CHARDEV_BACKEND_KIND_PARALLEL,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004411 qemu_chr_parse_parallel, NULL);
4412 register_char_driver("pty", CHARDEV_BACKEND_KIND_PTY, NULL,
4413 NULL);
4414 register_char_driver("console", CHARDEV_BACKEND_KIND_CONSOLE, NULL,
4415 NULL);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004416 register_char_driver("pipe", CHARDEV_BACKEND_KIND_PIPE,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004417 qemu_chr_parse_pipe, NULL);
4418 register_char_driver("mux", CHARDEV_BACKEND_KIND_MUX, qemu_chr_parse_mux,
4419 NULL);
Markus Armbrusterc11ed962013-07-26 16:44:33 +02004420 /* Bug-compatibility: */
Peter Maydelle4d50d42014-09-02 11:24:17 +01004421 register_char_driver("memory", CHARDEV_BACKEND_KIND_MEMORY,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004422 qemu_chr_parse_ringbuf, NULL);
Michael Roth7b7ab182013-07-30 13:04:22 -05004423 /* this must be done after machine init, since we register FEs with muxes
4424 * as part of realize functions like serial_isa_realizefn when -nographic
4425 * is specified
4426 */
4427 qemu_add_machine_init_done_notifier(&muxes_realize_notify);
Anthony Liguorid654f342013-03-05 23:21:28 +05304428}
4429
4430type_init(register_types);