blob: ee6381bbea7ca8ed1be919ca5b1b9501842774e3 [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
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02001756static CharDriverState *qemu_chr_open_pp_fd(int fd, Error **errp)
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) {
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02001762 error_setg_errno(errp, errno, "not a parallel port");
aliguori6f97dba2008-10-31 18:49:55 +00001763 close(fd);
Markus Armbruster1f514702012-02-07 15:09:08 +01001764 return NULL;
aliguori6f97dba2008-10-31 18:49:55 +00001765 }
1766
Markus Armbruster2d528d42015-09-14 13:54:03 +02001767 drv = g_new0(ParallelCharDriver, 1);
aliguori6f97dba2008-10-31 18:49:55 +00001768 drv->fd = fd;
1769 drv->mode = IEEE1284_MODE_COMPAT;
1770
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02001771 chr = qemu_chr_alloc();
aliguori6f97dba2008-10-31 18:49:55 +00001772 chr->chr_write = null_chr_write;
1773 chr->chr_ioctl = pp_ioctl;
1774 chr->chr_close = pp_close;
1775 chr->opaque = drv;
1776
Markus Armbruster1f514702012-02-07 15:09:08 +01001777 return chr;
aliguori6f97dba2008-10-31 18:49:55 +00001778}
1779#endif /* __linux__ */
1780
Aurelien Jarnoa167ba52009-11-29 18:00:41 +01001781#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__DragonFly__)
Gerd Hoffmanne5514982012-12-19 16:35:42 +01001782
1783#define HAVE_CHARDEV_PARPORT 1
1784
blueswir16972f932008-11-22 20:49:12 +00001785static int pp_ioctl(CharDriverState *chr, int cmd, void *arg)
1786{
Stefan Weile0efb992011-02-23 19:09:16 +01001787 int fd = (int)(intptr_t)chr->opaque;
blueswir16972f932008-11-22 20:49:12 +00001788 uint8_t b;
1789
1790 switch(cmd) {
1791 case CHR_IOCTL_PP_READ_DATA:
1792 if (ioctl(fd, PPIGDATA, &b) < 0)
1793 return -ENOTSUP;
1794 *(uint8_t *)arg = b;
1795 break;
1796 case CHR_IOCTL_PP_WRITE_DATA:
1797 b = *(uint8_t *)arg;
1798 if (ioctl(fd, PPISDATA, &b) < 0)
1799 return -ENOTSUP;
1800 break;
1801 case CHR_IOCTL_PP_READ_CONTROL:
1802 if (ioctl(fd, PPIGCTRL, &b) < 0)
1803 return -ENOTSUP;
1804 *(uint8_t *)arg = b;
1805 break;
1806 case CHR_IOCTL_PP_WRITE_CONTROL:
1807 b = *(uint8_t *)arg;
1808 if (ioctl(fd, PPISCTRL, &b) < 0)
1809 return -ENOTSUP;
1810 break;
1811 case CHR_IOCTL_PP_READ_STATUS:
1812 if (ioctl(fd, PPIGSTATUS, &b) < 0)
1813 return -ENOTSUP;
1814 *(uint8_t *)arg = b;
1815 break;
1816 default:
1817 return -ENOTSUP;
1818 }
1819 return 0;
1820}
1821
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02001822static CharDriverState *qemu_chr_open_pp_fd(int fd, Error **errp)
blueswir16972f932008-11-22 20:49:12 +00001823{
1824 CharDriverState *chr;
blueswir16972f932008-11-22 20:49:12 +00001825
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02001826 chr = qemu_chr_alloc();
Stefan Weile0efb992011-02-23 19:09:16 +01001827 chr->opaque = (void *)(intptr_t)fd;
blueswir16972f932008-11-22 20:49:12 +00001828 chr->chr_write = null_chr_write;
1829 chr->chr_ioctl = pp_ioctl;
Michael Rothbd5c51e2013-06-07 15:19:53 -05001830 chr->explicit_be_open = true;
Markus Armbruster1f514702012-02-07 15:09:08 +01001831 return chr;
blueswir16972f932008-11-22 20:49:12 +00001832}
1833#endif
1834
aliguori6f97dba2008-10-31 18:49:55 +00001835#else /* _WIN32 */
1836
Paolo Bonzinid809ab92015-10-12 09:46:23 +02001837#define HAVE_CHARDEV_SERIAL 1
1838
aliguori6f97dba2008-10-31 18:49:55 +00001839typedef struct {
1840 int max_size;
1841 HANDLE hcom, hrecv, hsend;
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001842 OVERLAPPED orecv;
aliguori6f97dba2008-10-31 18:49:55 +00001843 BOOL fpipe;
1844 DWORD len;
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001845
1846 /* Protected by the CharDriverState chr_write_lock. */
1847 OVERLAPPED osend;
aliguori6f97dba2008-10-31 18:49:55 +00001848} WinCharState;
1849
Fabien Chouteaudb418a02011-10-06 16:37:51 +02001850typedef struct {
1851 HANDLE hStdIn;
1852 HANDLE hInputReadyEvent;
1853 HANDLE hInputDoneEvent;
1854 HANDLE hInputThread;
1855 uint8_t win_stdio_buf;
1856} WinStdioCharState;
1857
aliguori6f97dba2008-10-31 18:49:55 +00001858#define NSENDBUF 2048
1859#define NRECVBUF 2048
1860#define MAXCONNECT 1
1861#define NTIMEOUT 5000
1862
1863static int win_chr_poll(void *opaque);
1864static int win_chr_pipe_poll(void *opaque);
1865
1866static void win_chr_close(CharDriverState *chr)
1867{
1868 WinCharState *s = chr->opaque;
1869
1870 if (s->hsend) {
1871 CloseHandle(s->hsend);
1872 s->hsend = NULL;
1873 }
1874 if (s->hrecv) {
1875 CloseHandle(s->hrecv);
1876 s->hrecv = NULL;
1877 }
1878 if (s->hcom) {
1879 CloseHandle(s->hcom);
1880 s->hcom = NULL;
1881 }
1882 if (s->fpipe)
1883 qemu_del_polling_cb(win_chr_pipe_poll, chr);
1884 else
1885 qemu_del_polling_cb(win_chr_poll, chr);
Amit Shah793cbfb2009-08-11 21:27:48 +05301886
Hans de Goedea425d232011-11-19 10:22:43 +01001887 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
aliguori6f97dba2008-10-31 18:49:55 +00001888}
1889
Paolo Bonzini6511d392015-09-29 15:08:05 +02001890static int win_chr_init(CharDriverState *chr, const char *filename, Error **errp)
aliguori6f97dba2008-10-31 18:49:55 +00001891{
1892 WinCharState *s = chr->opaque;
1893 COMMCONFIG comcfg;
1894 COMMTIMEOUTS cto = { 0, 0, 0, 0, 0};
1895 COMSTAT comstat;
1896 DWORD size;
1897 DWORD err;
1898
1899 s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
1900 if (!s->hsend) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001901 error_setg(errp, "Failed CreateEvent");
aliguori6f97dba2008-10-31 18:49:55 +00001902 goto fail;
1903 }
1904 s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
1905 if (!s->hrecv) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001906 error_setg(errp, "Failed CreateEvent");
aliguori6f97dba2008-10-31 18:49:55 +00001907 goto fail;
1908 }
1909
1910 s->hcom = CreateFile(filename, GENERIC_READ|GENERIC_WRITE, 0, NULL,
1911 OPEN_EXISTING, FILE_FLAG_OVERLAPPED, 0);
1912 if (s->hcom == INVALID_HANDLE_VALUE) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001913 error_setg(errp, "Failed CreateFile (%lu)", GetLastError());
aliguori6f97dba2008-10-31 18:49:55 +00001914 s->hcom = NULL;
1915 goto fail;
1916 }
1917
1918 if (!SetupComm(s->hcom, NRECVBUF, NSENDBUF)) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001919 error_setg(errp, "Failed SetupComm");
aliguori6f97dba2008-10-31 18:49:55 +00001920 goto fail;
1921 }
1922
1923 ZeroMemory(&comcfg, sizeof(COMMCONFIG));
1924 size = sizeof(COMMCONFIG);
1925 GetDefaultCommConfig(filename, &comcfg, &size);
1926 comcfg.dcb.DCBlength = sizeof(DCB);
1927 CommConfigDialog(filename, NULL, &comcfg);
1928
1929 if (!SetCommState(s->hcom, &comcfg.dcb)) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001930 error_setg(errp, "Failed SetCommState");
aliguori6f97dba2008-10-31 18:49:55 +00001931 goto fail;
1932 }
1933
1934 if (!SetCommMask(s->hcom, EV_ERR)) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001935 error_setg(errp, "Failed SetCommMask");
aliguori6f97dba2008-10-31 18:49:55 +00001936 goto fail;
1937 }
1938
1939 cto.ReadIntervalTimeout = MAXDWORD;
1940 if (!SetCommTimeouts(s->hcom, &cto)) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001941 error_setg(errp, "Failed SetCommTimeouts");
aliguori6f97dba2008-10-31 18:49:55 +00001942 goto fail;
1943 }
1944
1945 if (!ClearCommError(s->hcom, &err, &comstat)) {
Paolo Bonzini6511d392015-09-29 15:08:05 +02001946 error_setg(errp, "Failed ClearCommError");
aliguori6f97dba2008-10-31 18:49:55 +00001947 goto fail;
1948 }
1949 qemu_add_polling_cb(win_chr_poll, chr);
1950 return 0;
1951
1952 fail:
1953 win_chr_close(chr);
1954 return -1;
1955}
1956
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02001957/* Called with chr_write_lock held. */
aliguori6f97dba2008-10-31 18:49:55 +00001958static int win_chr_write(CharDriverState *chr, const uint8_t *buf, int len1)
1959{
1960 WinCharState *s = chr->opaque;
1961 DWORD len, ret, size, err;
1962
1963 len = len1;
1964 ZeroMemory(&s->osend, sizeof(s->osend));
1965 s->osend.hEvent = s->hsend;
1966 while (len > 0) {
1967 if (s->hsend)
1968 ret = WriteFile(s->hcom, buf, len, &size, &s->osend);
1969 else
1970 ret = WriteFile(s->hcom, buf, len, &size, NULL);
1971 if (!ret) {
1972 err = GetLastError();
1973 if (err == ERROR_IO_PENDING) {
1974 ret = GetOverlappedResult(s->hcom, &s->osend, &size, TRUE);
1975 if (ret) {
1976 buf += size;
1977 len -= size;
1978 } else {
1979 break;
1980 }
1981 } else {
1982 break;
1983 }
1984 } else {
1985 buf += size;
1986 len -= size;
1987 }
1988 }
1989 return len1 - len;
1990}
1991
1992static int win_chr_read_poll(CharDriverState *chr)
1993{
1994 WinCharState *s = chr->opaque;
1995
Anthony Liguori909cda12011-08-15 11:17:31 -05001996 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00001997 return s->max_size;
1998}
1999
2000static void win_chr_readfile(CharDriverState *chr)
2001{
2002 WinCharState *s = chr->opaque;
2003 int ret, err;
Amit Shah9bd78542009-11-03 19:59:54 +05302004 uint8_t buf[READ_BUF_LEN];
aliguori6f97dba2008-10-31 18:49:55 +00002005 DWORD size;
2006
2007 ZeroMemory(&s->orecv, sizeof(s->orecv));
2008 s->orecv.hEvent = s->hrecv;
2009 ret = ReadFile(s->hcom, buf, s->len, &size, &s->orecv);
2010 if (!ret) {
2011 err = GetLastError();
2012 if (err == ERROR_IO_PENDING) {
2013 ret = GetOverlappedResult(s->hcom, &s->orecv, &size, TRUE);
2014 }
2015 }
2016
2017 if (size > 0) {
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05002018 qemu_chr_be_write(chr, buf, size);
aliguori6f97dba2008-10-31 18:49:55 +00002019 }
2020}
2021
2022static void win_chr_read(CharDriverState *chr)
2023{
2024 WinCharState *s = chr->opaque;
2025
2026 if (s->len > s->max_size)
2027 s->len = s->max_size;
2028 if (s->len == 0)
2029 return;
2030
2031 win_chr_readfile(chr);
2032}
2033
2034static int win_chr_poll(void *opaque)
2035{
2036 CharDriverState *chr = opaque;
2037 WinCharState *s = chr->opaque;
2038 COMSTAT status;
2039 DWORD comerr;
2040
2041 ClearCommError(s->hcom, &comerr, &status);
2042 if (status.cbInQue > 0) {
2043 s->len = status.cbInQue;
2044 win_chr_read_poll(chr);
2045 win_chr_read(chr);
2046 return 1;
2047 }
2048 return 0;
2049}
2050
Paolo Bonzini6511d392015-09-29 15:08:05 +02002051static CharDriverState *qemu_chr_open_win_path(const char *filename,
2052 Error **errp)
aliguori6f97dba2008-10-31 18:49:55 +00002053{
2054 CharDriverState *chr;
2055 WinCharState *s;
2056
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02002057 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02002058 s = g_new0(WinCharState, 1);
aliguori6f97dba2008-10-31 18:49:55 +00002059 chr->opaque = s;
2060 chr->chr_write = win_chr_write;
2061 chr->chr_close = win_chr_close;
2062
Paolo Bonzini6511d392015-09-29 15:08:05 +02002063 if (win_chr_init(chr, filename, errp) < 0) {
Stefan Weil2e02e182011-10-07 07:38:46 +02002064 g_free(s);
2065 g_free(chr);
Markus Armbruster1f514702012-02-07 15:09:08 +01002066 return NULL;
aliguori6f97dba2008-10-31 18:49:55 +00002067 }
Markus Armbruster1f514702012-02-07 15:09:08 +01002068 return chr;
aliguori6f97dba2008-10-31 18:49:55 +00002069}
2070
2071static int win_chr_pipe_poll(void *opaque)
2072{
2073 CharDriverState *chr = opaque;
2074 WinCharState *s = chr->opaque;
2075 DWORD size;
2076
2077 PeekNamedPipe(s->hcom, NULL, 0, NULL, &size, NULL);
2078 if (size > 0) {
2079 s->len = size;
2080 win_chr_read_poll(chr);
2081 win_chr_read(chr);
2082 return 1;
2083 }
2084 return 0;
2085}
2086
2087static int win_chr_pipe_init(CharDriverState *chr, const char *filename)
2088{
2089 WinCharState *s = chr->opaque;
2090 OVERLAPPED ov;
2091 int ret;
2092 DWORD size;
Corey Minyard9f781162014-10-02 11:17:33 -05002093 char openname[CHR_MAX_FILENAME_SIZE];
aliguori6f97dba2008-10-31 18:49:55 +00002094
2095 s->fpipe = TRUE;
2096
2097 s->hsend = CreateEvent(NULL, TRUE, FALSE, NULL);
2098 if (!s->hsend) {
2099 fprintf(stderr, "Failed CreateEvent\n");
2100 goto fail;
2101 }
2102 s->hrecv = CreateEvent(NULL, TRUE, FALSE, NULL);
2103 if (!s->hrecv) {
2104 fprintf(stderr, "Failed CreateEvent\n");
2105 goto fail;
2106 }
2107
2108 snprintf(openname, sizeof(openname), "\\\\.\\pipe\\%s", filename);
2109 s->hcom = CreateNamedPipe(openname, PIPE_ACCESS_DUPLEX | FILE_FLAG_OVERLAPPED,
2110 PIPE_TYPE_BYTE | PIPE_READMODE_BYTE |
2111 PIPE_WAIT,
2112 MAXCONNECT, NSENDBUF, NRECVBUF, NTIMEOUT, NULL);
2113 if (s->hcom == INVALID_HANDLE_VALUE) {
2114 fprintf(stderr, "Failed CreateNamedPipe (%lu)\n", GetLastError());
2115 s->hcom = NULL;
2116 goto fail;
2117 }
2118
2119 ZeroMemory(&ov, sizeof(ov));
2120 ov.hEvent = CreateEvent(NULL, TRUE, FALSE, NULL);
2121 ret = ConnectNamedPipe(s->hcom, &ov);
2122 if (ret) {
2123 fprintf(stderr, "Failed ConnectNamedPipe\n");
2124 goto fail;
2125 }
2126
2127 ret = GetOverlappedResult(s->hcom, &ov, &size, TRUE);
2128 if (!ret) {
2129 fprintf(stderr, "Failed GetOverlappedResult\n");
2130 if (ov.hEvent) {
2131 CloseHandle(ov.hEvent);
2132 ov.hEvent = NULL;
2133 }
2134 goto fail;
2135 }
2136
2137 if (ov.hEvent) {
2138 CloseHandle(ov.hEvent);
2139 ov.hEvent = NULL;
2140 }
2141 qemu_add_polling_cb(win_chr_pipe_poll, chr);
2142 return 0;
2143
2144 fail:
2145 win_chr_close(chr);
2146 return -1;
2147}
2148
2149
Gerd Hoffmann548cbb32013-02-25 11:50:55 +01002150static CharDriverState *qemu_chr_open_pipe(ChardevHostdev *opts)
aliguori6f97dba2008-10-31 18:49:55 +00002151{
Gerd Hoffmann548cbb32013-02-25 11:50:55 +01002152 const char *filename = opts->device;
aliguori6f97dba2008-10-31 18:49:55 +00002153 CharDriverState *chr;
2154 WinCharState *s;
2155
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02002156 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02002157 s = g_new0(WinCharState, 1);
aliguori6f97dba2008-10-31 18:49:55 +00002158 chr->opaque = s;
2159 chr->chr_write = win_chr_write;
2160 chr->chr_close = win_chr_close;
2161
2162 if (win_chr_pipe_init(chr, filename) < 0) {
Stefan Weil2e02e182011-10-07 07:38:46 +02002163 g_free(s);
2164 g_free(chr);
Markus Armbruster1f514702012-02-07 15:09:08 +01002165 return NULL;
aliguori6f97dba2008-10-31 18:49:55 +00002166 }
Markus Armbruster1f514702012-02-07 15:09:08 +01002167 return chr;
aliguori6f97dba2008-10-31 18:49:55 +00002168}
2169
Markus Armbruster1f514702012-02-07 15:09:08 +01002170static CharDriverState *qemu_chr_open_win_file(HANDLE fd_out)
aliguori6f97dba2008-10-31 18:49:55 +00002171{
2172 CharDriverState *chr;
2173 WinCharState *s;
2174
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02002175 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02002176 s = g_new0(WinCharState, 1);
aliguori6f97dba2008-10-31 18:49:55 +00002177 s->hcom = fd_out;
2178 chr->opaque = s;
2179 chr->chr_write = win_chr_write;
Markus Armbruster1f514702012-02-07 15:09:08 +01002180 return chr;
aliguori6f97dba2008-10-31 18:49:55 +00002181}
2182
Gerd Hoffmannd9ac3742013-02-25 11:48:06 +01002183static CharDriverState *qemu_chr_open_win_con(void)
aliguori6f97dba2008-10-31 18:49:55 +00002184{
Markus Armbruster1f514702012-02-07 15:09:08 +01002185 return qemu_chr_open_win_file(GetStdHandle(STD_OUTPUT_HANDLE));
aliguori6f97dba2008-10-31 18:49:55 +00002186}
2187
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002188static int win_stdio_write(CharDriverState *chr, const uint8_t *buf, int len)
2189{
2190 HANDLE hStdOut = GetStdHandle(STD_OUTPUT_HANDLE);
2191 DWORD dwSize;
2192 int len1;
2193
2194 len1 = len;
2195
2196 while (len1 > 0) {
2197 if (!WriteFile(hStdOut, buf, len1, &dwSize, NULL)) {
2198 break;
2199 }
2200 buf += dwSize;
2201 len1 -= dwSize;
2202 }
2203
2204 return len - len1;
2205}
2206
2207static void win_stdio_wait_func(void *opaque)
2208{
2209 CharDriverState *chr = opaque;
2210 WinStdioCharState *stdio = chr->opaque;
2211 INPUT_RECORD buf[4];
2212 int ret;
2213 DWORD dwSize;
2214 int i;
2215
Stefan Weildff74242013-12-07 14:48:04 +01002216 ret = ReadConsoleInput(stdio->hStdIn, buf, ARRAY_SIZE(buf), &dwSize);
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002217
2218 if (!ret) {
2219 /* Avoid error storm */
2220 qemu_del_wait_object(stdio->hStdIn, NULL, NULL);
2221 return;
2222 }
2223
2224 for (i = 0; i < dwSize; i++) {
2225 KEY_EVENT_RECORD *kev = &buf[i].Event.KeyEvent;
2226
2227 if (buf[i].EventType == KEY_EVENT && kev->bKeyDown) {
2228 int j;
2229 if (kev->uChar.AsciiChar != 0) {
2230 for (j = 0; j < kev->wRepeatCount; j++) {
2231 if (qemu_chr_be_can_write(chr)) {
2232 uint8_t c = kev->uChar.AsciiChar;
2233 qemu_chr_be_write(chr, &c, 1);
2234 }
2235 }
2236 }
2237 }
2238 }
2239}
2240
2241static DWORD WINAPI win_stdio_thread(LPVOID param)
2242{
2243 CharDriverState *chr = param;
2244 WinStdioCharState *stdio = chr->opaque;
2245 int ret;
2246 DWORD dwSize;
2247
2248 while (1) {
2249
2250 /* Wait for one byte */
2251 ret = ReadFile(stdio->hStdIn, &stdio->win_stdio_buf, 1, &dwSize, NULL);
2252
2253 /* Exit in case of error, continue if nothing read */
2254 if (!ret) {
2255 break;
2256 }
2257 if (!dwSize) {
2258 continue;
2259 }
2260
2261 /* Some terminal emulator returns \r\n for Enter, just pass \n */
2262 if (stdio->win_stdio_buf == '\r') {
2263 continue;
2264 }
2265
2266 /* Signal the main thread and wait until the byte was eaten */
2267 if (!SetEvent(stdio->hInputReadyEvent)) {
2268 break;
2269 }
2270 if (WaitForSingleObject(stdio->hInputDoneEvent, INFINITE)
2271 != WAIT_OBJECT_0) {
2272 break;
2273 }
2274 }
2275
2276 qemu_del_wait_object(stdio->hInputReadyEvent, NULL, NULL);
2277 return 0;
2278}
2279
2280static void win_stdio_thread_wait_func(void *opaque)
2281{
2282 CharDriverState *chr = opaque;
2283 WinStdioCharState *stdio = chr->opaque;
2284
2285 if (qemu_chr_be_can_write(chr)) {
2286 qemu_chr_be_write(chr, &stdio->win_stdio_buf, 1);
2287 }
2288
2289 SetEvent(stdio->hInputDoneEvent);
2290}
2291
2292static void qemu_chr_set_echo_win_stdio(CharDriverState *chr, bool echo)
2293{
2294 WinStdioCharState *stdio = chr->opaque;
2295 DWORD dwMode = 0;
2296
2297 GetConsoleMode(stdio->hStdIn, &dwMode);
2298
2299 if (echo) {
2300 SetConsoleMode(stdio->hStdIn, dwMode | ENABLE_ECHO_INPUT);
2301 } else {
2302 SetConsoleMode(stdio->hStdIn, dwMode & ~ENABLE_ECHO_INPUT);
2303 }
2304}
2305
2306static void win_stdio_close(CharDriverState *chr)
2307{
2308 WinStdioCharState *stdio = chr->opaque;
2309
2310 if (stdio->hInputReadyEvent != INVALID_HANDLE_VALUE) {
2311 CloseHandle(stdio->hInputReadyEvent);
2312 }
2313 if (stdio->hInputDoneEvent != INVALID_HANDLE_VALUE) {
2314 CloseHandle(stdio->hInputDoneEvent);
2315 }
2316 if (stdio->hInputThread != INVALID_HANDLE_VALUE) {
2317 TerminateThread(stdio->hInputThread, 0);
2318 }
2319
2320 g_free(chr->opaque);
2321 g_free(chr);
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002322}
2323
Gerd Hoffmann7c358032013-02-21 12:34:58 +01002324static CharDriverState *qemu_chr_open_stdio(ChardevStdio *opts)
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002325{
2326 CharDriverState *chr;
2327 WinStdioCharState *stdio;
2328 DWORD dwMode;
2329 int is_console = 0;
2330
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02002331 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02002332 stdio = g_new0(WinStdioCharState, 1);
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002333
2334 stdio->hStdIn = GetStdHandle(STD_INPUT_HANDLE);
2335 if (stdio->hStdIn == INVALID_HANDLE_VALUE) {
2336 fprintf(stderr, "cannot open stdio: invalid handle\n");
2337 exit(1);
2338 }
2339
2340 is_console = GetConsoleMode(stdio->hStdIn, &dwMode) != 0;
2341
2342 chr->opaque = stdio;
2343 chr->chr_write = win_stdio_write;
2344 chr->chr_close = win_stdio_close;
2345
Anthony Liguoried7a1542013-03-05 23:21:17 +05302346 if (is_console) {
2347 if (qemu_add_wait_object(stdio->hStdIn,
2348 win_stdio_wait_func, chr)) {
2349 fprintf(stderr, "qemu_add_wait_object: failed\n");
2350 }
2351 } else {
2352 DWORD dwId;
2353
2354 stdio->hInputReadyEvent = CreateEvent(NULL, FALSE, FALSE, NULL);
2355 stdio->hInputDoneEvent = CreateEvent(NULL, FALSE, FALSE, NULL);
2356 stdio->hInputThread = CreateThread(NULL, 0, win_stdio_thread,
2357 chr, 0, &dwId);
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002358
Anthony Liguoried7a1542013-03-05 23:21:17 +05302359 if (stdio->hInputThread == INVALID_HANDLE_VALUE
2360 || stdio->hInputReadyEvent == INVALID_HANDLE_VALUE
2361 || stdio->hInputDoneEvent == INVALID_HANDLE_VALUE) {
2362 fprintf(stderr, "cannot create stdio thread or event\n");
2363 exit(1);
2364 }
2365 if (qemu_add_wait_object(stdio->hInputReadyEvent,
2366 win_stdio_thread_wait_func, chr)) {
2367 fprintf(stderr, "qemu_add_wait_object: failed\n");
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002368 }
2369 }
2370
2371 dwMode |= ENABLE_LINE_INPUT;
2372
Anthony Liguoried7a1542013-03-05 23:21:17 +05302373 if (is_console) {
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002374 /* set the terminal in raw mode */
2375 /* ENABLE_QUICK_EDIT_MODE | ENABLE_EXTENDED_FLAGS */
2376 dwMode |= ENABLE_PROCESSED_INPUT;
2377 }
2378
2379 SetConsoleMode(stdio->hStdIn, dwMode);
2380
2381 chr->chr_set_echo = qemu_chr_set_echo_win_stdio;
2382 qemu_chr_fe_set_echo(chr, false);
2383
Markus Armbruster1f514702012-02-07 15:09:08 +01002384 return chr;
Fabien Chouteaudb418a02011-10-06 16:37:51 +02002385}
aliguori6f97dba2008-10-31 18:49:55 +00002386#endif /* !_WIN32 */
2387
Anthony Liguori5ab82112013-03-05 23:21:31 +05302388
aliguori6f97dba2008-10-31 18:49:55 +00002389/***********************************************************/
2390/* UDP Net console */
2391
2392typedef struct {
2393 int fd;
Anthony Liguori76a96442013-03-05 23:21:21 +05302394 GIOChannel *chan;
Amit Shah9bd78542009-11-03 19:59:54 +05302395 uint8_t buf[READ_BUF_LEN];
aliguori6f97dba2008-10-31 18:49:55 +00002396 int bufcnt;
2397 int bufptr;
2398 int max_size;
2399} NetCharDriver;
2400
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02002401/* Called with chr_write_lock held. */
aliguori6f97dba2008-10-31 18:49:55 +00002402static int udp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2403{
2404 NetCharDriver *s = chr->opaque;
Anthony Liguori76a96442013-03-05 23:21:21 +05302405 gsize bytes_written;
2406 GIOStatus status;
aliguori6f97dba2008-10-31 18:49:55 +00002407
Anthony Liguori76a96442013-03-05 23:21:21 +05302408 status = g_io_channel_write_chars(s->chan, (const gchar *)buf, len, &bytes_written, NULL);
2409 if (status == G_IO_STATUS_EOF) {
2410 return 0;
2411 } else if (status != G_IO_STATUS_NORMAL) {
2412 return -1;
2413 }
2414
2415 return bytes_written;
aliguori6f97dba2008-10-31 18:49:55 +00002416}
2417
2418static int udp_chr_read_poll(void *opaque)
2419{
2420 CharDriverState *chr = opaque;
2421 NetCharDriver *s = chr->opaque;
2422
Anthony Liguori909cda12011-08-15 11:17:31 -05002423 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002424
2425 /* If there were any stray characters in the queue process them
2426 * first
2427 */
2428 while (s->max_size > 0 && s->bufptr < s->bufcnt) {
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05002429 qemu_chr_be_write(chr, &s->buf[s->bufptr], 1);
aliguori6f97dba2008-10-31 18:49:55 +00002430 s->bufptr++;
Anthony Liguori909cda12011-08-15 11:17:31 -05002431 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002432 }
2433 return s->max_size;
2434}
2435
Anthony Liguori76a96442013-03-05 23:21:21 +05302436static gboolean udp_chr_read(GIOChannel *chan, GIOCondition cond, void *opaque)
aliguori6f97dba2008-10-31 18:49:55 +00002437{
2438 CharDriverState *chr = opaque;
2439 NetCharDriver *s = chr->opaque;
Anthony Liguori76a96442013-03-05 23:21:21 +05302440 gsize bytes_read = 0;
2441 GIOStatus status;
aliguori6f97dba2008-10-31 18:49:55 +00002442
Paolo Bonzinicdbf6e12013-04-19 17:32:08 +02002443 if (s->max_size == 0) {
2444 return TRUE;
2445 }
Anthony Liguori76a96442013-03-05 23:21:21 +05302446 status = g_io_channel_read_chars(s->chan, (gchar *)s->buf, sizeof(s->buf),
2447 &bytes_read, NULL);
2448 s->bufcnt = bytes_read;
aliguori6f97dba2008-10-31 18:49:55 +00002449 s->bufptr = s->bufcnt;
Anthony Liguori76a96442013-03-05 23:21:21 +05302450 if (status != G_IO_STATUS_NORMAL) {
Amit Shah26da70c2013-08-28 15:23:37 +05302451 remove_fd_in_watch(chr);
Anthony Liguori76a96442013-03-05 23:21:21 +05302452 return FALSE;
2453 }
aliguori6f97dba2008-10-31 18:49:55 +00002454
2455 s->bufptr = 0;
2456 while (s->max_size > 0 && s->bufptr < s->bufcnt) {
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05002457 qemu_chr_be_write(chr, &s->buf[s->bufptr], 1);
aliguori6f97dba2008-10-31 18:49:55 +00002458 s->bufptr++;
Anthony Liguori909cda12011-08-15 11:17:31 -05002459 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002460 }
Anthony Liguori76a96442013-03-05 23:21:21 +05302461
2462 return TRUE;
aliguori6f97dba2008-10-31 18:49:55 +00002463}
2464
2465static void udp_chr_update_read_handler(CharDriverState *chr)
2466{
2467 NetCharDriver *s = chr->opaque;
2468
Amit Shah26da70c2013-08-28 15:23:37 +05302469 remove_fd_in_watch(chr);
Anthony Liguori76a96442013-03-05 23:21:21 +05302470 if (s->chan) {
Amit Shah7ba9add2013-08-28 15:18:29 +05302471 chr->fd_in_tag = io_add_watch_poll(s->chan, udp_chr_read_poll,
2472 udp_chr_read, chr);
aliguori6f97dba2008-10-31 18:49:55 +00002473 }
2474}
2475
aliguori819f56b2009-03-28 17:58:14 +00002476static void udp_chr_close(CharDriverState *chr)
2477{
2478 NetCharDriver *s = chr->opaque;
Amit Shah26da70c2013-08-28 15:23:37 +05302479
2480 remove_fd_in_watch(chr);
Anthony Liguori76a96442013-03-05 23:21:21 +05302481 if (s->chan) {
2482 g_io_channel_unref(s->chan);
aliguori819f56b2009-03-28 17:58:14 +00002483 closesocket(s->fd);
2484 }
Anthony Liguori7267c092011-08-20 22:09:37 -05002485 g_free(s);
Hans de Goedea425d232011-11-19 10:22:43 +01002486 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
aliguori819f56b2009-03-28 17:58:14 +00002487}
2488
Gerd Hoffmann3ecc0592013-02-27 14:10:47 +01002489static CharDriverState *qemu_chr_open_udp_fd(int fd)
aliguori6f97dba2008-10-31 18:49:55 +00002490{
2491 CharDriverState *chr = NULL;
2492 NetCharDriver *s = NULL;
aliguori6f97dba2008-10-31 18:49:55 +00002493
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02002494 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02002495 s = g_new0(NetCharDriver, 1);
aliguori6f97dba2008-10-31 18:49:55 +00002496
aliguori6f97dba2008-10-31 18:49:55 +00002497 s->fd = fd;
Anthony Liguori76a96442013-03-05 23:21:21 +05302498 s->chan = io_channel_from_socket(s->fd);
aliguori6f97dba2008-10-31 18:49:55 +00002499 s->bufcnt = 0;
2500 s->bufptr = 0;
2501 chr->opaque = s;
2502 chr->chr_write = udp_chr_write;
2503 chr->chr_update_read_handler = udp_chr_update_read_handler;
aliguori819f56b2009-03-28 17:58:14 +00002504 chr->chr_close = udp_chr_close;
Michael Rothbd5c51e2013-06-07 15:19:53 -05002505 /* be isn't opened until we get a connection */
2506 chr->explicit_be_open = true;
Markus Armbruster1f514702012-02-07 15:09:08 +01002507 return chr;
Gerd Hoffmann3ecc0592013-02-27 14:10:47 +01002508}
aliguori6f97dba2008-10-31 18:49:55 +00002509
aliguori6f97dba2008-10-31 18:49:55 +00002510/***********************************************************/
2511/* TCP Net console */
2512
2513typedef struct {
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302514
2515 GIOChannel *chan, *listen_chan;
Amit Shah7ba9add2013-08-28 15:18:29 +05302516 guint listen_tag;
aliguori6f97dba2008-10-31 18:49:55 +00002517 int fd, listen_fd;
2518 int connected;
2519 int max_size;
2520 int do_telnetopt;
2521 int do_nodelay;
2522 int is_unix;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002523 int *read_msgfds;
2524 int read_msgfds_num;
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002525 int *write_msgfds;
2526 int write_msgfds_num;
Corey Minyardcfb429c2014-10-02 11:17:35 -05002527
2528 SocketAddress *addr;
2529 bool is_listen;
2530 bool is_telnet;
Corey Minyard5dd1f022014-10-02 11:17:37 -05002531
2532 guint reconnect_timer;
2533 int64_t reconnect_time;
Corey Minyard5008e5b2014-10-08 07:11:55 -05002534 bool connect_err_reported;
aliguori6f97dba2008-10-31 18:49:55 +00002535} TCPCharDriver;
2536
Corey Minyard5dd1f022014-10-02 11:17:37 -05002537static gboolean socket_reconnect_timeout(gpointer opaque);
2538
2539static void qemu_chr_socket_restart_timer(CharDriverState *chr)
2540{
2541 TCPCharDriver *s = chr->opaque;
2542 assert(s->connected == 0);
2543 s->reconnect_timer = g_timeout_add_seconds(s->reconnect_time,
2544 socket_reconnect_timeout, chr);
2545}
2546
Corey Minyard5008e5b2014-10-08 07:11:55 -05002547static void check_report_connect_error(CharDriverState *chr,
2548 Error *err)
2549{
2550 TCPCharDriver *s = chr->opaque;
2551
2552 if (!s->connect_err_reported) {
2553 error_report("Unable to connect character device %s: %s",
2554 chr->label, error_get_pretty(err));
2555 s->connect_err_reported = true;
2556 }
2557 qemu_chr_socket_restart_timer(chr);
2558}
2559
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302560static gboolean tcp_chr_accept(GIOChannel *chan, GIOCondition cond, void *opaque);
aliguori6f97dba2008-10-31 18:49:55 +00002561
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002562#ifndef _WIN32
2563static int unix_send_msgfds(CharDriverState *chr, const uint8_t *buf, int len)
2564{
2565 TCPCharDriver *s = chr->opaque;
2566 struct msghdr msgh;
2567 struct iovec iov;
2568 int r;
2569
2570 size_t fd_size = s->write_msgfds_num * sizeof(int);
2571 char control[CMSG_SPACE(fd_size)];
2572 struct cmsghdr *cmsg;
2573
2574 memset(&msgh, 0, sizeof(msgh));
2575 memset(control, 0, sizeof(control));
2576
2577 /* set the payload */
2578 iov.iov_base = (uint8_t *) buf;
2579 iov.iov_len = len;
2580
2581 msgh.msg_iov = &iov;
2582 msgh.msg_iovlen = 1;
2583
2584 msgh.msg_control = control;
2585 msgh.msg_controllen = sizeof(control);
2586
2587 cmsg = CMSG_FIRSTHDR(&msgh);
2588
2589 cmsg->cmsg_len = CMSG_LEN(fd_size);
2590 cmsg->cmsg_level = SOL_SOCKET;
2591 cmsg->cmsg_type = SCM_RIGHTS;
2592 memcpy(CMSG_DATA(cmsg), s->write_msgfds, fd_size);
2593
2594 do {
2595 r = sendmsg(s->fd, &msgh, 0);
2596 } while (r < 0 && errno == EINTR);
2597
2598 /* free the written msgfds, no matter what */
2599 if (s->write_msgfds_num) {
2600 g_free(s->write_msgfds);
2601 s->write_msgfds = 0;
2602 s->write_msgfds_num = 0;
2603 }
2604
2605 return r;
2606}
2607#endif
2608
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02002609/* Called with chr_write_lock held. */
aliguori6f97dba2008-10-31 18:49:55 +00002610static int tcp_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
2611{
2612 TCPCharDriver *s = chr->opaque;
2613 if (s->connected) {
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002614#ifndef _WIN32
2615 if (s->is_unix && s->write_msgfds_num) {
2616 return unix_send_msgfds(chr, buf, len);
2617 } else
2618#endif
2619 {
2620 return io_channel_send(s->chan, buf, len);
2621 }
Anthony Liguori455aa1e2012-09-05 13:52:49 -05002622 } else {
Anthony Liguori6db0fdc2012-09-12 14:34:07 -05002623 /* XXX: indicate an error ? */
Anthony Liguori455aa1e2012-09-05 13:52:49 -05002624 return len;
aliguori6f97dba2008-10-31 18:49:55 +00002625 }
2626}
2627
2628static int tcp_chr_read_poll(void *opaque)
2629{
2630 CharDriverState *chr = opaque;
2631 TCPCharDriver *s = chr->opaque;
2632 if (!s->connected)
2633 return 0;
Anthony Liguori909cda12011-08-15 11:17:31 -05002634 s->max_size = qemu_chr_be_can_write(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002635 return s->max_size;
2636}
2637
2638#define IAC 255
2639#define IAC_BREAK 243
2640static void tcp_chr_process_IAC_bytes(CharDriverState *chr,
2641 TCPCharDriver *s,
2642 uint8_t *buf, int *size)
2643{
2644 /* Handle any telnet client's basic IAC options to satisfy char by
2645 * char mode with no echo. All IAC options will be removed from
2646 * the buf and the do_telnetopt variable will be used to track the
2647 * state of the width of the IAC information.
2648 *
2649 * IAC commands come in sets of 3 bytes with the exception of the
2650 * "IAC BREAK" command and the double IAC.
2651 */
2652
2653 int i;
2654 int j = 0;
2655
2656 for (i = 0; i < *size; i++) {
2657 if (s->do_telnetopt > 1) {
2658 if ((unsigned char)buf[i] == IAC && s->do_telnetopt == 2) {
2659 /* Double IAC means send an IAC */
2660 if (j != i)
2661 buf[j] = buf[i];
2662 j++;
2663 s->do_telnetopt = 1;
2664 } else {
2665 if ((unsigned char)buf[i] == IAC_BREAK && s->do_telnetopt == 2) {
2666 /* Handle IAC break commands by sending a serial break */
Hans de Goedea425d232011-11-19 10:22:43 +01002667 qemu_chr_be_event(chr, CHR_EVENT_BREAK);
aliguori6f97dba2008-10-31 18:49:55 +00002668 s->do_telnetopt++;
2669 }
2670 s->do_telnetopt++;
2671 }
2672 if (s->do_telnetopt >= 4) {
2673 s->do_telnetopt = 1;
2674 }
2675 } else {
2676 if ((unsigned char)buf[i] == IAC) {
2677 s->do_telnetopt = 2;
2678 } else {
2679 if (j != i)
2680 buf[j] = buf[i];
2681 j++;
2682 }
2683 }
2684 }
2685 *size = j;
2686}
2687
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002688static int tcp_get_msgfds(CharDriverState *chr, int *fds, int num)
Mark McLoughlin7d174052009-07-22 09:11:39 +01002689{
2690 TCPCharDriver *s = chr->opaque;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002691 int to_copy = (s->read_msgfds_num < num) ? s->read_msgfds_num : num;
2692
Michael S. Tsirkinc4095722014-11-02 18:48:32 +02002693 assert(num <= TCP_MAX_FDS);
2694
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002695 if (to_copy) {
Stefan Hajnoczid2fc39b2014-06-22 10:38:37 +08002696 int i;
2697
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002698 memcpy(fds, s->read_msgfds, to_copy * sizeof(int));
2699
Stefan Hajnoczid2fc39b2014-06-22 10:38:37 +08002700 /* Close unused fds */
2701 for (i = to_copy; i < s->read_msgfds_num; i++) {
2702 close(s->read_msgfds[i]);
2703 }
2704
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002705 g_free(s->read_msgfds);
2706 s->read_msgfds = 0;
2707 s->read_msgfds_num = 0;
2708 }
2709
2710 return to_copy;
Mark McLoughlin7d174052009-07-22 09:11:39 +01002711}
2712
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002713static int tcp_set_msgfds(CharDriverState *chr, int *fds, int num)
2714{
2715 TCPCharDriver *s = chr->opaque;
2716
2717 /* clear old pending fd array */
Daniel P. Berrangeef1e1e02015-08-26 12:17:18 +01002718 g_free(s->write_msgfds);
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002719
2720 if (num) {
Markus Armbruster2d528d42015-09-14 13:54:03 +02002721 s->write_msgfds = g_new(int, num);
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03002722 memcpy(s->write_msgfds, fds, num * sizeof(int));
2723 }
2724
2725 s->write_msgfds_num = num;
2726
2727 return 0;
2728}
2729
Anthony Liguori73bcc2a2009-07-27 14:55:25 -05002730#ifndef _WIN32
Mark McLoughlin7d174052009-07-22 09:11:39 +01002731static void unix_process_msgfd(CharDriverState *chr, struct msghdr *msg)
2732{
2733 TCPCharDriver *s = chr->opaque;
2734 struct cmsghdr *cmsg;
2735
2736 for (cmsg = CMSG_FIRSTHDR(msg); cmsg; cmsg = CMSG_NXTHDR(msg, cmsg)) {
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002737 int fd_size, i;
Mark McLoughlin7d174052009-07-22 09:11:39 +01002738
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002739 if (cmsg->cmsg_len < CMSG_LEN(sizeof(int)) ||
Mark McLoughlin7d174052009-07-22 09:11:39 +01002740 cmsg->cmsg_level != SOL_SOCKET ||
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002741 cmsg->cmsg_type != SCM_RIGHTS) {
Mark McLoughlin7d174052009-07-22 09:11:39 +01002742 continue;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002743 }
Mark McLoughlin7d174052009-07-22 09:11:39 +01002744
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002745 fd_size = cmsg->cmsg_len - CMSG_LEN(0);
2746
2747 if (!fd_size) {
Mark McLoughlin7d174052009-07-22 09:11:39 +01002748 continue;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002749 }
Mark McLoughlin7d174052009-07-22 09:11:39 +01002750
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002751 /* close and clean read_msgfds */
2752 for (i = 0; i < s->read_msgfds_num; i++) {
2753 close(s->read_msgfds[i]);
2754 }
Stefan Hajnoczi9b938c72013-03-27 10:10:46 +01002755
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03002756 if (s->read_msgfds_num) {
2757 g_free(s->read_msgfds);
2758 }
2759
2760 s->read_msgfds_num = fd_size / sizeof(int);
2761 s->read_msgfds = g_malloc(fd_size);
2762 memcpy(s->read_msgfds, CMSG_DATA(cmsg), fd_size);
2763
2764 for (i = 0; i < s->read_msgfds_num; i++) {
2765 int fd = s->read_msgfds[i];
2766 if (fd < 0) {
2767 continue;
2768 }
2769
2770 /* O_NONBLOCK is preserved across SCM_RIGHTS so reset it */
2771 qemu_set_block(fd);
2772
2773 #ifndef MSG_CMSG_CLOEXEC
2774 qemu_set_cloexec(fd);
2775 #endif
2776 }
Mark McLoughlin7d174052009-07-22 09:11:39 +01002777 }
2778}
2779
Mark McLoughlin9977c892009-07-22 09:11:38 +01002780static ssize_t tcp_chr_recv(CharDriverState *chr, char *buf, size_t len)
2781{
2782 TCPCharDriver *s = chr->opaque;
Blue Swirl7cba04f2009-08-01 10:13:20 +00002783 struct msghdr msg = { NULL, };
Mark McLoughlin9977c892009-07-22 09:11:38 +01002784 struct iovec iov[1];
Mark McLoughlin7d174052009-07-22 09:11:39 +01002785 union {
2786 struct cmsghdr cmsg;
Michael S. Tsirkinc4095722014-11-02 18:48:32 +02002787 char control[CMSG_SPACE(sizeof(int) * TCP_MAX_FDS)];
Mark McLoughlin7d174052009-07-22 09:11:39 +01002788 } msg_control;
Corey Bryant06138652012-08-14 16:43:42 -04002789 int flags = 0;
Mark McLoughlin7d174052009-07-22 09:11:39 +01002790 ssize_t ret;
Mark McLoughlin9977c892009-07-22 09:11:38 +01002791
2792 iov[0].iov_base = buf;
2793 iov[0].iov_len = len;
2794
2795 msg.msg_iov = iov;
2796 msg.msg_iovlen = 1;
Mark McLoughlin7d174052009-07-22 09:11:39 +01002797 msg.msg_control = &msg_control;
2798 msg.msg_controllen = sizeof(msg_control);
Mark McLoughlin9977c892009-07-22 09:11:38 +01002799
Corey Bryant06138652012-08-14 16:43:42 -04002800#ifdef MSG_CMSG_CLOEXEC
2801 flags |= MSG_CMSG_CLOEXEC;
2802#endif
Paolo Bonzini9172f422015-07-21 09:25:54 +02002803 do {
2804 ret = recvmsg(s->fd, &msg, flags);
2805 } while (ret == -1 && errno == EINTR);
2806
Corey Bryant06138652012-08-14 16:43:42 -04002807 if (ret > 0 && s->is_unix) {
Mark McLoughlin7d174052009-07-22 09:11:39 +01002808 unix_process_msgfd(chr, &msg);
Corey Bryant06138652012-08-14 16:43:42 -04002809 }
Mark McLoughlin7d174052009-07-22 09:11:39 +01002810
2811 return ret;
Mark McLoughlin9977c892009-07-22 09:11:38 +01002812}
2813#else
2814static ssize_t tcp_chr_recv(CharDriverState *chr, char *buf, size_t len)
2815{
2816 TCPCharDriver *s = chr->opaque;
Paolo Bonzini9172f422015-07-21 09:25:54 +02002817 ssize_t ret;
2818
2819 do {
2820 ret = qemu_recv(s->fd, buf, len, 0);
2821 } while (ret == -1 && socket_error() == EINTR);
2822
2823 return ret;
Mark McLoughlin9977c892009-07-22 09:11:38 +01002824}
2825#endif
2826
Amit Shahd3cc5bc2013-03-05 23:21:25 +05302827static GSource *tcp_chr_add_watch(CharDriverState *chr, GIOCondition cond)
2828{
2829 TCPCharDriver *s = chr->opaque;
2830 return g_io_create_watch(s->chan, cond);
2831}
2832
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +03002833static void tcp_chr_disconnect(CharDriverState *chr)
2834{
2835 TCPCharDriver *s = chr->opaque;
2836
2837 s->connected = 0;
2838 if (s->listen_chan) {
2839 s->listen_tag = g_io_add_watch(s->listen_chan, G_IO_IN,
2840 tcp_chr_accept, chr);
2841 }
2842 remove_fd_in_watch(chr);
2843 g_io_channel_unref(s->chan);
2844 s->chan = NULL;
2845 closesocket(s->fd);
2846 s->fd = -1;
Corey Minyard16cc4ff2014-10-02 11:17:36 -05002847 SocketAddress_to_str(chr->filename, CHR_MAX_FILENAME_SIZE,
2848 "disconnected:", s->addr, s->is_listen, s->is_telnet);
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +03002849 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
Corey Minyard5dd1f022014-10-02 11:17:37 -05002850 if (s->reconnect_time) {
2851 qemu_chr_socket_restart_timer(chr);
2852 }
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +03002853}
2854
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302855static gboolean tcp_chr_read(GIOChannel *chan, GIOCondition cond, void *opaque)
aliguori6f97dba2008-10-31 18:49:55 +00002856{
2857 CharDriverState *chr = opaque;
2858 TCPCharDriver *s = chr->opaque;
Amit Shah9bd78542009-11-03 19:59:54 +05302859 uint8_t buf[READ_BUF_LEN];
aliguori6f97dba2008-10-31 18:49:55 +00002860 int len, size;
2861
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302862 if (!s->connected || s->max_size <= 0) {
Paolo Bonzinicdbf6e12013-04-19 17:32:08 +02002863 return TRUE;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302864 }
aliguori6f97dba2008-10-31 18:49:55 +00002865 len = sizeof(buf);
2866 if (len > s->max_size)
2867 len = s->max_size;
Mark McLoughlin9977c892009-07-22 09:11:38 +01002868 size = tcp_chr_recv(chr, (void *)buf, len);
Nils Carlson4bf1cb02015-07-19 20:39:56 +00002869 if (size == 0 ||
2870 (size < 0 &&
2871 socket_error() != EAGAIN && socket_error() != EWOULDBLOCK)) {
aliguori6f97dba2008-10-31 18:49:55 +00002872 /* connection closed */
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +03002873 tcp_chr_disconnect(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002874 } else if (size > 0) {
2875 if (s->do_telnetopt)
2876 tcp_chr_process_IAC_bytes(chr, s, buf, &size);
2877 if (size > 0)
Anthony Liguorifa5efcc2011-08-15 11:17:30 -05002878 qemu_chr_be_write(chr, buf, size);
aliguori6f97dba2008-10-31 18:49:55 +00002879 }
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302880
2881 return TRUE;
aliguori6f97dba2008-10-31 18:49:55 +00002882}
2883
Nikolay Nikolaev7b0bfdf2014-05-27 15:03:48 +03002884static int tcp_chr_sync_read(CharDriverState *chr, const uint8_t *buf, int len)
2885{
2886 TCPCharDriver *s = chr->opaque;
2887 int size;
2888
2889 if (!s->connected) {
2890 return 0;
2891 }
2892
2893 size = tcp_chr_recv(chr, (void *) buf, len);
2894 if (size == 0) {
2895 /* connection closed */
2896 tcp_chr_disconnect(chr);
2897 }
2898
2899 return size;
2900}
2901
Blue Swirl68c18d12010-08-15 09:46:24 +00002902#ifndef _WIN32
2903CharDriverState *qemu_chr_open_eventfd(int eventfd)
2904{
David Marchande9d21c42014-06-11 17:25:16 +02002905 CharDriverState *chr = qemu_chr_open_fd(eventfd, eventfd);
2906
2907 if (chr) {
2908 chr->avail_connections = 1;
2909 }
2910
2911 return chr;
Cam Macdonell6cbf4c82010-07-27 10:54:13 -06002912}
Blue Swirl68c18d12010-08-15 09:46:24 +00002913#endif
Cam Macdonell6cbf4c82010-07-27 10:54:13 -06002914
aliguori6f97dba2008-10-31 18:49:55 +00002915static void tcp_chr_connect(void *opaque)
2916{
2917 CharDriverState *chr = opaque;
2918 TCPCharDriver *s = chr->opaque;
Corey Minyard01ca5192014-10-02 11:17:38 -05002919 struct sockaddr_storage ss, ps;
2920 socklen_t ss_len = sizeof(ss), ps_len = sizeof(ps);
Corey Minyard16cc4ff2014-10-02 11:17:36 -05002921
2922 memset(&ss, 0, ss_len);
2923 if (getsockname(s->fd, (struct sockaddr *) &ss, &ss_len) != 0) {
2924 snprintf(chr->filename, CHR_MAX_FILENAME_SIZE,
2925 "Error in getsockname: %s\n", strerror(errno));
Corey Minyard01ca5192014-10-02 11:17:38 -05002926 } else if (getpeername(s->fd, (struct sockaddr *) &ps, &ps_len) != 0) {
2927 snprintf(chr->filename, CHR_MAX_FILENAME_SIZE,
2928 "Error in getpeername: %s\n", strerror(errno));
Corey Minyard16cc4ff2014-10-02 11:17:36 -05002929 } else {
Corey Minyard01ca5192014-10-02 11:17:38 -05002930 sockaddr_to_str(chr->filename, CHR_MAX_FILENAME_SIZE,
2931 &ss, ss_len, &ps, ps_len,
Corey Minyard16cc4ff2014-10-02 11:17:36 -05002932 s->is_listen, s->is_telnet);
2933 }
aliguori6f97dba2008-10-31 18:49:55 +00002934
2935 s->connected = 1;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302936 if (s->chan) {
Amit Shah7ba9add2013-08-28 15:18:29 +05302937 chr->fd_in_tag = io_add_watch_poll(s->chan, tcp_chr_read_poll,
2938 tcp_chr_read, chr);
David Gibsonbbdd2ad2012-09-10 12:30:56 +10002939 }
Hans de Goedefee204f2013-03-26 11:07:54 +01002940 qemu_chr_be_generic_open(chr);
aliguori6f97dba2008-10-31 18:49:55 +00002941}
2942
Gal Hammerac1b84d2014-02-25 12:12:35 +02002943static void tcp_chr_update_read_handler(CharDriverState *chr)
2944{
2945 TCPCharDriver *s = chr->opaque;
2946
2947 remove_fd_in_watch(chr);
2948 if (s->chan) {
2949 chr->fd_in_tag = io_add_watch_poll(s->chan, tcp_chr_read_poll,
2950 tcp_chr_read, chr);
2951 }
2952}
2953
aliguori6f97dba2008-10-31 18:49:55 +00002954#define IACSET(x,a,b,c) x[0] = a; x[1] = b; x[2] = c;
2955static void tcp_chr_telnet_init(int fd)
2956{
2957 char buf[3];
2958 /* Send the telnet negotion to put telnet in binary, no echo, single char mode */
2959 IACSET(buf, 0xff, 0xfb, 0x01); /* IAC WILL ECHO */
2960 send(fd, (char *)buf, 3, 0);
2961 IACSET(buf, 0xff, 0xfb, 0x03); /* IAC WILL Suppress go ahead */
2962 send(fd, (char *)buf, 3, 0);
2963 IACSET(buf, 0xff, 0xfb, 0x00); /* IAC WILL Binary */
2964 send(fd, (char *)buf, 3, 0);
2965 IACSET(buf, 0xff, 0xfd, 0x00); /* IAC DO Binary */
2966 send(fd, (char *)buf, 3, 0);
2967}
2968
Daniel P. Berrange13661082011-06-23 13:31:42 +01002969static int tcp_chr_add_client(CharDriverState *chr, int fd)
2970{
2971 TCPCharDriver *s = chr->opaque;
2972 if (s->fd != -1)
2973 return -1;
2974
Stefan Hajnoczif9e8cac2013-03-27 10:10:43 +01002975 qemu_set_nonblock(fd);
Daniel P. Berrange13661082011-06-23 13:31:42 +01002976 if (s->do_nodelay)
2977 socket_set_nodelay(fd);
2978 s->fd = fd;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302979 s->chan = io_channel_from_socket(fd);
Paolo Bonzini910b6362013-04-19 17:32:06 +02002980 if (s->listen_tag) {
2981 g_source_remove(s->listen_tag);
2982 s->listen_tag = 0;
2983 }
Daniel P. Berrange13661082011-06-23 13:31:42 +01002984 tcp_chr_connect(chr);
2985
2986 return 0;
2987}
2988
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05302989static gboolean tcp_chr_accept(GIOChannel *channel, GIOCondition cond, void *opaque)
aliguori6f97dba2008-10-31 18:49:55 +00002990{
2991 CharDriverState *chr = opaque;
2992 TCPCharDriver *s = chr->opaque;
2993 struct sockaddr_in saddr;
2994#ifndef _WIN32
2995 struct sockaddr_un uaddr;
2996#endif
2997 struct sockaddr *addr;
2998 socklen_t len;
2999 int fd;
3000
3001 for(;;) {
3002#ifndef _WIN32
3003 if (s->is_unix) {
3004 len = sizeof(uaddr);
3005 addr = (struct sockaddr *)&uaddr;
3006 } else
3007#endif
3008 {
3009 len = sizeof(saddr);
3010 addr = (struct sockaddr *)&saddr;
3011 }
Kevin Wolf40ff6d72009-12-02 12:24:42 +01003012 fd = qemu_accept(s->listen_fd, addr, &len);
aliguori6f97dba2008-10-31 18:49:55 +00003013 if (fd < 0 && errno != EINTR) {
Hans de Goede79f20072013-04-25 13:53:02 +02003014 s->listen_tag = 0;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303015 return FALSE;
aliguori6f97dba2008-10-31 18:49:55 +00003016 } else if (fd >= 0) {
3017 if (s->do_telnetopt)
3018 tcp_chr_telnet_init(fd);
3019 break;
3020 }
3021 }
Daniel P. Berrange13661082011-06-23 13:31:42 +01003022 if (tcp_chr_add_client(chr, fd) < 0)
3023 close(fd);
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303024
3025 return TRUE;
aliguori6f97dba2008-10-31 18:49:55 +00003026}
3027
3028static void tcp_chr_close(CharDriverState *chr)
3029{
3030 TCPCharDriver *s = chr->opaque;
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03003031 int i;
Corey Minyardcfb429c2014-10-02 11:17:35 -05003032
Corey Minyard5dd1f022014-10-02 11:17:37 -05003033 if (s->reconnect_timer) {
3034 g_source_remove(s->reconnect_timer);
3035 s->reconnect_timer = 0;
3036 }
Corey Minyardcfb429c2014-10-02 11:17:35 -05003037 qapi_free_SocketAddress(s->addr);
aliguori819f56b2009-03-28 17:58:14 +00003038 if (s->fd >= 0) {
Amit Shah26da70c2013-08-28 15:23:37 +05303039 remove_fd_in_watch(chr);
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303040 if (s->chan) {
3041 g_io_channel_unref(s->chan);
3042 }
aliguori6f97dba2008-10-31 18:49:55 +00003043 closesocket(s->fd);
aliguori819f56b2009-03-28 17:58:14 +00003044 }
3045 if (s->listen_fd >= 0) {
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303046 if (s->listen_tag) {
3047 g_source_remove(s->listen_tag);
Paolo Bonzini910b6362013-04-19 17:32:06 +02003048 s->listen_tag = 0;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303049 }
3050 if (s->listen_chan) {
3051 g_io_channel_unref(s->listen_chan);
3052 }
aliguori6f97dba2008-10-31 18:49:55 +00003053 closesocket(s->listen_fd);
aliguori819f56b2009-03-28 17:58:14 +00003054 }
Nikolay Nikolaevc76bf6b2014-05-27 15:04:15 +03003055 if (s->read_msgfds_num) {
3056 for (i = 0; i < s->read_msgfds_num; i++) {
3057 close(s->read_msgfds[i]);
3058 }
3059 g_free(s->read_msgfds);
3060 }
Nikolay Nikolaevd39aac72014-05-27 15:04:02 +03003061 if (s->write_msgfds_num) {
3062 g_free(s->write_msgfds);
3063 }
Anthony Liguori7267c092011-08-20 22:09:37 -05003064 g_free(s);
Hans de Goedea425d232011-11-19 10:22:43 +01003065 qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
aliguori6f97dba2008-10-31 18:49:55 +00003066}
3067
Corey Minyard16cc4ff2014-10-02 11:17:36 -05003068static void qemu_chr_finish_socket_connection(CharDriverState *chr, int fd)
aliguori6f97dba2008-10-31 18:49:55 +00003069{
Corey Minyard43ded1a2014-10-02 11:17:34 -05003070 TCPCharDriver *s = chr->opaque;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003071
Corey Minyardcfb429c2014-10-02 11:17:35 -05003072 if (s->is_listen) {
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003073 s->listen_fd = fd;
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303074 s->listen_chan = io_channel_from_socket(s->listen_fd);
Corey Minyard43ded1a2014-10-02 11:17:34 -05003075 s->listen_tag = g_io_add_watch(s->listen_chan, G_IO_IN,
3076 tcp_chr_accept, chr);
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003077 } else {
3078 s->connected = 1;
3079 s->fd = fd;
3080 socket_set_nodelay(fd);
Anthony Liguori2ea5a7a2013-03-05 23:21:22 +05303081 s->chan = io_channel_from_socket(s->fd);
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003082 tcp_chr_connect(chr);
3083 }
Corey Minyard43ded1a2014-10-02 11:17:34 -05003084}
3085
Corey Minyard51795022014-10-08 07:11:56 -05003086static void qemu_chr_socket_connected(int fd, Error *err, void *opaque)
Corey Minyard5dd1f022014-10-02 11:17:37 -05003087{
3088 CharDriverState *chr = opaque;
Corey Minyard5008e5b2014-10-08 07:11:55 -05003089 TCPCharDriver *s = chr->opaque;
Corey Minyard5dd1f022014-10-02 11:17:37 -05003090
3091 if (fd < 0) {
Corey Minyard5008e5b2014-10-08 07:11:55 -05003092 check_report_connect_error(chr, err);
Corey Minyard5dd1f022014-10-02 11:17:37 -05003093 return;
3094 }
3095
Corey Minyard5008e5b2014-10-08 07:11:55 -05003096 s->connect_err_reported = false;
Corey Minyard5dd1f022014-10-02 11:17:37 -05003097 qemu_chr_finish_socket_connection(chr, fd);
3098}
3099
Corey Minyardcfb429c2014-10-02 11:17:35 -05003100static bool qemu_chr_open_socket_fd(CharDriverState *chr, Error **errp)
Corey Minyard43ded1a2014-10-02 11:17:34 -05003101{
Corey Minyardcfb429c2014-10-02 11:17:35 -05003102 TCPCharDriver *s = chr->opaque;
Corey Minyard43ded1a2014-10-02 11:17:34 -05003103 int fd;
3104
Corey Minyardcfb429c2014-10-02 11:17:35 -05003105 if (s->is_listen) {
3106 fd = socket_listen(s->addr, errp);
Corey Minyard5dd1f022014-10-02 11:17:37 -05003107 } else if (s->reconnect_time) {
3108 fd = socket_connect(s->addr, errp, qemu_chr_socket_connected, chr);
3109 return fd >= 0;
3110 } else {
Corey Minyardcfb429c2014-10-02 11:17:35 -05003111 fd = socket_connect(s->addr, errp, NULL, NULL);
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003112 }
Corey Minyard43ded1a2014-10-02 11:17:34 -05003113 if (fd < 0) {
3114 return false;
3115 }
3116
Corey Minyard16cc4ff2014-10-02 11:17:36 -05003117 qemu_chr_finish_socket_connection(chr, fd);
3118 return true;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01003119}
3120
Lei Li51767e72013-01-25 00:03:19 +08003121/*********************************************************/
Markus Armbruster3949e592013-02-06 21:27:24 +01003122/* Ring buffer chardev */
Lei Li51767e72013-01-25 00:03:19 +08003123
3124typedef struct {
3125 size_t size;
3126 size_t prod;
3127 size_t cons;
3128 uint8_t *cbuf;
Markus Armbruster3949e592013-02-06 21:27:24 +01003129} RingBufCharDriver;
Lei Li51767e72013-01-25 00:03:19 +08003130
Markus Armbruster3949e592013-02-06 21:27:24 +01003131static size_t ringbuf_count(const CharDriverState *chr)
Lei Li51767e72013-01-25 00:03:19 +08003132{
Markus Armbruster3949e592013-02-06 21:27:24 +01003133 const RingBufCharDriver *d = chr->opaque;
Lei Li51767e72013-01-25 00:03:19 +08003134
Markus Armbruster5c230102013-02-06 21:27:23 +01003135 return d->prod - d->cons;
Lei Li51767e72013-01-25 00:03:19 +08003136}
3137
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02003138/* Called with chr_write_lock held. */
Markus Armbruster3949e592013-02-06 21:27:24 +01003139static int ringbuf_chr_write(CharDriverState *chr, const uint8_t *buf, int len)
Lei Li51767e72013-01-25 00:03:19 +08003140{
Markus Armbruster3949e592013-02-06 21:27:24 +01003141 RingBufCharDriver *d = chr->opaque;
Lei Li51767e72013-01-25 00:03:19 +08003142 int i;
3143
3144 if (!buf || (len < 0)) {
3145 return -1;
3146 }
3147
3148 for (i = 0; i < len; i++ ) {
Markus Armbruster5c230102013-02-06 21:27:23 +01003149 d->cbuf[d->prod++ & (d->size - 1)] = buf[i];
3150 if (d->prod - d->cons > d->size) {
Lei Li51767e72013-01-25 00:03:19 +08003151 d->cons = d->prod - d->size;
3152 }
3153 }
3154
3155 return 0;
3156}
3157
Markus Armbruster3949e592013-02-06 21:27:24 +01003158static int ringbuf_chr_read(CharDriverState *chr, uint8_t *buf, int len)
Lei Li51767e72013-01-25 00:03:19 +08003159{
Markus Armbruster3949e592013-02-06 21:27:24 +01003160 RingBufCharDriver *d = chr->opaque;
Lei Li51767e72013-01-25 00:03:19 +08003161 int i;
3162
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02003163 qemu_mutex_lock(&chr->chr_write_lock);
Markus Armbruster5c230102013-02-06 21:27:23 +01003164 for (i = 0; i < len && d->cons != d->prod; i++) {
3165 buf[i] = d->cbuf[d->cons++ & (d->size - 1)];
Lei Li51767e72013-01-25 00:03:19 +08003166 }
Paolo Bonzini9005b2a2014-06-18 08:43:58 +02003167 qemu_mutex_unlock(&chr->chr_write_lock);
Lei Li51767e72013-01-25 00:03:19 +08003168
3169 return i;
3170}
3171
Markus Armbruster3949e592013-02-06 21:27:24 +01003172static void ringbuf_chr_close(struct CharDriverState *chr)
Lei Li51767e72013-01-25 00:03:19 +08003173{
Markus Armbruster3949e592013-02-06 21:27:24 +01003174 RingBufCharDriver *d = chr->opaque;
Lei Li51767e72013-01-25 00:03:19 +08003175
3176 g_free(d->cbuf);
3177 g_free(d);
3178 chr->opaque = NULL;
3179}
3180
Markus Armbruster4f573782013-07-26 16:44:32 +02003181static CharDriverState *qemu_chr_open_ringbuf(ChardevRingbuf *opts,
3182 Error **errp)
Lei Li51767e72013-01-25 00:03:19 +08003183{
3184 CharDriverState *chr;
Markus Armbruster3949e592013-02-06 21:27:24 +01003185 RingBufCharDriver *d;
Lei Li51767e72013-01-25 00:03:19 +08003186
Paolo Bonzinidb39fcf2014-06-18 08:43:55 +02003187 chr = qemu_chr_alloc();
Lei Li51767e72013-01-25 00:03:19 +08003188 d = g_malloc(sizeof(*d));
3189
Gerd Hoffmann1da48c62013-02-26 16:21:11 +01003190 d->size = opts->has_size ? opts->size : 65536;
Lei Li51767e72013-01-25 00:03:19 +08003191
3192 /* The size must be power of 2 */
3193 if (d->size & (d->size - 1)) {
Markus Armbruster4f573782013-07-26 16:44:32 +02003194 error_setg(errp, "size of ringbuf chardev must be power of two");
Lei Li51767e72013-01-25 00:03:19 +08003195 goto fail;
3196 }
3197
3198 d->prod = 0;
3199 d->cons = 0;
3200 d->cbuf = g_malloc0(d->size);
3201
3202 chr->opaque = d;
Markus Armbruster3949e592013-02-06 21:27:24 +01003203 chr->chr_write = ringbuf_chr_write;
3204 chr->chr_close = ringbuf_chr_close;
Lei Li51767e72013-01-25 00:03:19 +08003205
3206 return chr;
3207
3208fail:
3209 g_free(d);
3210 g_free(chr);
3211 return NULL;
3212}
3213
Hani Benhabiles8e597772014-05-27 23:39:30 +01003214bool chr_is_ringbuf(const CharDriverState *chr)
Lei Li1f590cf2013-01-25 00:03:20 +08003215{
Markus Armbruster3949e592013-02-06 21:27:24 +01003216 return chr->chr_write == ringbuf_chr_write;
Lei Li1f590cf2013-01-25 00:03:20 +08003217}
3218
Markus Armbruster3949e592013-02-06 21:27:24 +01003219void qmp_ringbuf_write(const char *device, const char *data,
Markus Armbruster82e59a62013-02-06 21:27:14 +01003220 bool has_format, enum DataFormat format,
Lei Li1f590cf2013-01-25 00:03:20 +08003221 Error **errp)
3222{
3223 CharDriverState *chr;
Markus Armbrusterc4f331b2013-02-06 21:27:17 +01003224 const uint8_t *write_data;
Lei Li1f590cf2013-01-25 00:03:20 +08003225 int ret;
Peter Crosthwaite3d1bba22013-05-22 13:01:43 +10003226 gsize write_count;
Lei Li1f590cf2013-01-25 00:03:20 +08003227
3228 chr = qemu_chr_find(device);
3229 if (!chr) {
Markus Armbruster1a692782013-02-06 21:27:16 +01003230 error_setg(errp, "Device '%s' not found", device);
Lei Li1f590cf2013-01-25 00:03:20 +08003231 return;
3232 }
3233
Markus Armbruster3949e592013-02-06 21:27:24 +01003234 if (!chr_is_ringbuf(chr)) {
3235 error_setg(errp,"%s is not a ringbuf device", device);
Lei Li1f590cf2013-01-25 00:03:20 +08003236 return;
3237 }
3238
Lei Li1f590cf2013-01-25 00:03:20 +08003239 if (has_format && (format == DATA_FORMAT_BASE64)) {
3240 write_data = g_base64_decode(data, &write_count);
3241 } else {
3242 write_data = (uint8_t *)data;
Markus Armbruster82e59a62013-02-06 21:27:14 +01003243 write_count = strlen(data);
Lei Li1f590cf2013-01-25 00:03:20 +08003244 }
3245
Markus Armbruster3949e592013-02-06 21:27:24 +01003246 ret = ringbuf_chr_write(chr, write_data, write_count);
Lei Li1f590cf2013-01-25 00:03:20 +08003247
Markus Armbruster13289fb2013-02-06 21:27:18 +01003248 if (write_data != (uint8_t *)data) {
3249 g_free((void *)write_data);
3250 }
3251
Lei Li1f590cf2013-01-25 00:03:20 +08003252 if (ret < 0) {
3253 error_setg(errp, "Failed to write to device %s", device);
3254 return;
3255 }
3256}
3257
Markus Armbruster3949e592013-02-06 21:27:24 +01003258char *qmp_ringbuf_read(const char *device, int64_t size,
Markus Armbruster3ab651f2013-02-06 21:27:15 +01003259 bool has_format, enum DataFormat format,
3260 Error **errp)
Lei Li49b6d722013-01-25 00:03:21 +08003261{
3262 CharDriverState *chr;
Markus Armbrusterc4f331b2013-02-06 21:27:17 +01003263 uint8_t *read_data;
Lei Li49b6d722013-01-25 00:03:21 +08003264 size_t count;
Markus Armbruster3ab651f2013-02-06 21:27:15 +01003265 char *data;
Lei Li49b6d722013-01-25 00:03:21 +08003266
3267 chr = qemu_chr_find(device);
3268 if (!chr) {
Markus Armbruster1a692782013-02-06 21:27:16 +01003269 error_setg(errp, "Device '%s' not found", device);
Lei Li49b6d722013-01-25 00:03:21 +08003270 return NULL;
3271 }
3272
Markus Armbruster3949e592013-02-06 21:27:24 +01003273 if (!chr_is_ringbuf(chr)) {
3274 error_setg(errp,"%s is not a ringbuf device", device);
Lei Li49b6d722013-01-25 00:03:21 +08003275 return NULL;
3276 }
3277
3278 if (size <= 0) {
3279 error_setg(errp, "size must be greater than zero");
3280 return NULL;
3281 }
3282
Markus Armbruster3949e592013-02-06 21:27:24 +01003283 count = ringbuf_count(chr);
Lei Li49b6d722013-01-25 00:03:21 +08003284 size = size > count ? count : size;
Markus Armbruster44f3bcd2013-02-06 21:27:20 +01003285 read_data = g_malloc(size + 1);
Lei Li49b6d722013-01-25 00:03:21 +08003286
Markus Armbruster3949e592013-02-06 21:27:24 +01003287 ringbuf_chr_read(chr, read_data, size);
Lei Li49b6d722013-01-25 00:03:21 +08003288
3289 if (has_format && (format == DATA_FORMAT_BASE64)) {
Markus Armbruster3ab651f2013-02-06 21:27:15 +01003290 data = g_base64_encode(read_data, size);
Markus Armbruster13289fb2013-02-06 21:27:18 +01003291 g_free(read_data);
Lei Li49b6d722013-01-25 00:03:21 +08003292 } else {
Markus Armbruster3949e592013-02-06 21:27:24 +01003293 /*
3294 * FIXME should read only complete, valid UTF-8 characters up
3295 * to @size bytes. Invalid sequences should be replaced by a
3296 * suitable replacement character. Except when (and only
3297 * when) ring buffer lost characters since last read, initial
3298 * continuation characters should be dropped.
3299 */
Markus Armbruster44f3bcd2013-02-06 21:27:20 +01003300 read_data[size] = 0;
Markus Armbruster3ab651f2013-02-06 21:27:15 +01003301 data = (char *)read_data;
Lei Li49b6d722013-01-25 00:03:21 +08003302 }
3303
Markus Armbruster3ab651f2013-02-06 21:27:15 +01003304 return data;
Lei Li49b6d722013-01-25 00:03:21 +08003305}
3306
Gerd Hoffmann33521632009-12-08 13:11:49 +01003307QemuOpts *qemu_chr_parse_compat(const char *label, const char *filename)
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003308{
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003309 char host[65], port[33], width[8], height[8];
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003310 int pos;
Gerd Hoffmann7d315442009-09-10 10:58:36 +02003311 const char *p;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003312 QemuOpts *opts;
Luiz Capitulino8be7e7e2012-03-20 15:51:57 -03003313 Error *local_err = NULL;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003314
Luiz Capitulino8be7e7e2012-03-20 15:51:57 -03003315 opts = qemu_opts_create(qemu_find_opts("chardev"), label, 1, &local_err);
Markus Armbruster84d18f02014-01-30 15:07:28 +01003316 if (local_err) {
Markus Armbruster33394882015-02-10 15:21:26 +01003317 error_report_err(local_err);
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003318 return NULL;
Luiz Capitulino8be7e7e2012-03-20 15:51:57 -03003319 }
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003320
Gerd Hoffmann7591c5c2009-09-10 10:58:50 +02003321 if (strstart(filename, "mon:", &p)) {
3322 filename = p;
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003323 qemu_opt_set(opts, "mux", "on", &error_abort);
Paolo Bonzini02c4bdf2013-07-03 20:29:45 +04003324 if (strcmp(filename, "stdio") == 0) {
3325 /* Monitor is muxed to stdio: do not exit on Ctrl+C by default
3326 * but pass it to the guest. Handle this only for compat syntax,
3327 * for -chardev syntax we have special option for this.
3328 * This is what -nographic did, redirecting+muxing serial+monitor
3329 * to stdio causing Ctrl+C to be passed to guest. */
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003330 qemu_opt_set(opts, "signal", "off", &error_abort);
Paolo Bonzini02c4bdf2013-07-03 20:29:45 +04003331 }
Gerd Hoffmann7591c5c2009-09-10 10:58:50 +02003332 }
3333
Gerd Hoffmannf0457e82009-09-10 10:58:45 +02003334 if (strcmp(filename, "null") == 0 ||
3335 strcmp(filename, "pty") == 0 ||
3336 strcmp(filename, "msmouse") == 0 ||
Gerd Hoffmanndc1c21e2009-09-10 10:58:46 +02003337 strcmp(filename, "braille") == 0 ||
Paolo Bonzini56923992014-07-11 09:44:26 +02003338 strcmp(filename, "testdev") == 0 ||
Gerd Hoffmannf0457e82009-09-10 10:58:45 +02003339 strcmp(filename, "stdio") == 0) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003340 qemu_opt_set(opts, "backend", filename, &error_abort);
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003341 return opts;
3342 }
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003343 if (strstart(filename, "vc", &p)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003344 qemu_opt_set(opts, "backend", "vc", &error_abort);
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003345 if (*p == ':') {
Stefan Weil49aa4052013-09-30 23:04:49 +02003346 if (sscanf(p+1, "%7[0-9]x%7[0-9]", width, height) == 2) {
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003347 /* pixels */
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003348 qemu_opt_set(opts, "width", width, &error_abort);
3349 qemu_opt_set(opts, "height", height, &error_abort);
Stefan Weil49aa4052013-09-30 23:04:49 +02003350 } else if (sscanf(p+1, "%7[0-9]Cx%7[0-9]C", width, height) == 2) {
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003351 /* chars */
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003352 qemu_opt_set(opts, "cols", width, &error_abort);
3353 qemu_opt_set(opts, "rows", height, &error_abort);
Gerd Hoffmann6ea314d2009-09-10 10:58:49 +02003354 } else {
3355 goto fail;
3356 }
3357 }
3358 return opts;
3359 }
Gerd Hoffmannd6c983c2009-09-10 10:58:47 +02003360 if (strcmp(filename, "con:") == 0) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003361 qemu_opt_set(opts, "backend", "console", &error_abort);
Gerd Hoffmannd6c983c2009-09-10 10:58:47 +02003362 return opts;
3363 }
Gerd Hoffmann48b76492009-09-10 10:58:48 +02003364 if (strstart(filename, "COM", NULL)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003365 qemu_opt_set(opts, "backend", "serial", &error_abort);
3366 qemu_opt_set(opts, "path", filename, &error_abort);
Gerd Hoffmann48b76492009-09-10 10:58:48 +02003367 return opts;
3368 }
Gerd Hoffmann7d315442009-09-10 10:58:36 +02003369 if (strstart(filename, "file:", &p)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003370 qemu_opt_set(opts, "backend", "file", &error_abort);
3371 qemu_opt_set(opts, "path", p, &error_abort);
Gerd Hoffmann7d315442009-09-10 10:58:36 +02003372 return opts;
3373 }
3374 if (strstart(filename, "pipe:", &p)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003375 qemu_opt_set(opts, "backend", "pipe", &error_abort);
3376 qemu_opt_set(opts, "path", p, &error_abort);
Gerd Hoffmann7d315442009-09-10 10:58:36 +02003377 return opts;
3378 }
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003379 if (strstart(filename, "tcp:", &p) ||
3380 strstart(filename, "telnet:", &p)) {
3381 if (sscanf(p, "%64[^:]:%32[^,]%n", host, port, &pos) < 2) {
3382 host[0] = 0;
3383 if (sscanf(p, ":%32[^,]%n", port, &pos) < 1)
3384 goto fail;
3385 }
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003386 qemu_opt_set(opts, "backend", "socket", &error_abort);
3387 qemu_opt_set(opts, "host", host, &error_abort);
3388 qemu_opt_set(opts, "port", port, &error_abort);
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003389 if (p[pos] == ',') {
Markus Armbrusterdc523cd342015-02-12 18:37:11 +01003390 qemu_opts_do_parse(opts, p+pos+1, NULL, &local_err);
3391 if (local_err) {
3392 error_report_err(local_err);
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003393 goto fail;
Markus Armbrusterdc523cd342015-02-12 18:37:11 +01003394 }
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003395 }
3396 if (strstart(filename, "telnet:", &p))
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003397 qemu_opt_set(opts, "telnet", "on", &error_abort);
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003398 return opts;
3399 }
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003400 if (strstart(filename, "udp:", &p)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003401 qemu_opt_set(opts, "backend", "udp", &error_abort);
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003402 if (sscanf(p, "%64[^:]:%32[^@,]%n", host, port, &pos) < 2) {
3403 host[0] = 0;
Jan Kiszka39324ca2010-03-07 11:28:48 +01003404 if (sscanf(p, ":%32[^@,]%n", port, &pos) < 1) {
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003405 goto fail;
3406 }
3407 }
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003408 qemu_opt_set(opts, "host", host, &error_abort);
3409 qemu_opt_set(opts, "port", port, &error_abort);
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003410 if (p[pos] == '@') {
3411 p += pos + 1;
3412 if (sscanf(p, "%64[^:]:%32[^,]%n", host, port, &pos) < 2) {
3413 host[0] = 0;
3414 if (sscanf(p, ":%32[^,]%n", port, &pos) < 1) {
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003415 goto fail;
3416 }
3417 }
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003418 qemu_opt_set(opts, "localaddr", host, &error_abort);
3419 qemu_opt_set(opts, "localport", port, &error_abort);
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003420 }
3421 return opts;
3422 }
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003423 if (strstart(filename, "unix:", &p)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003424 qemu_opt_set(opts, "backend", "socket", &error_abort);
Markus Armbrusterdc523cd342015-02-12 18:37:11 +01003425 qemu_opts_do_parse(opts, p, "path", &local_err);
3426 if (local_err) {
3427 error_report_err(local_err);
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003428 goto fail;
Markus Armbrusterdc523cd342015-02-12 18:37:11 +01003429 }
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003430 return opts;
3431 }
Gerd Hoffmann48b76492009-09-10 10:58:48 +02003432 if (strstart(filename, "/dev/parport", NULL) ||
3433 strstart(filename, "/dev/ppi", NULL)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003434 qemu_opt_set(opts, "backend", "parport", &error_abort);
3435 qemu_opt_set(opts, "path", filename, &error_abort);
Gerd Hoffmann48b76492009-09-10 10:58:48 +02003436 return opts;
3437 }
3438 if (strstart(filename, "/dev/", NULL)) {
Markus Armbrusterf43e47d2015-02-12 17:52:20 +01003439 qemu_opt_set(opts, "backend", "tty", &error_abort);
3440 qemu_opt_set(opts, "path", filename, &error_abort);
Gerd Hoffmann48b76492009-09-10 10:58:48 +02003441 return opts;
3442 }
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003443
Gerd Hoffmannaeb2c472009-09-10 10:58:42 +02003444fail:
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003445 qemu_opts_del(opts);
3446 return NULL;
3447}
3448
Gerd Hoffmann846e2e42013-02-21 12:07:14 +01003449static void qemu_chr_parse_file_out(QemuOpts *opts, ChardevBackend *backend,
3450 Error **errp)
3451{
3452 const char *path = qemu_opt_get(opts, "path");
3453
3454 if (path == NULL) {
3455 error_setg(errp, "chardev: file: no filename given");
3456 return;
3457 }
3458 backend->file = g_new0(ChardevFile, 1);
3459 backend->file->out = g_strdup(path);
3460}
3461
Gerd Hoffmann7c358032013-02-21 12:34:58 +01003462static void qemu_chr_parse_stdio(QemuOpts *opts, ChardevBackend *backend,
3463 Error **errp)
3464{
3465 backend->stdio = g_new0(ChardevStdio, 1);
3466 backend->stdio->has_signal = true;
Paolo Bonzini02c4bdf2013-07-03 20:29:45 +04003467 backend->stdio->signal = qemu_opt_get_bool(opts, "signal", true);
Gerd Hoffmann7c358032013-02-21 12:34:58 +01003468}
3469
Paolo Bonzini6511d392015-09-29 15:08:05 +02003470#ifdef HAVE_CHARDEV_SERIAL
Gerd Hoffmann0f1cb512013-02-22 15:48:05 +01003471static void qemu_chr_parse_serial(QemuOpts *opts, ChardevBackend *backend,
3472 Error **errp)
3473{
3474 const char *device = qemu_opt_get(opts, "path");
3475
3476 if (device == NULL) {
3477 error_setg(errp, "chardev: serial/tty: no device path given");
3478 return;
3479 }
3480 backend->serial = g_new0(ChardevHostdev, 1);
3481 backend->serial->device = g_strdup(device);
3482}
Paolo Bonzini6511d392015-09-29 15:08:05 +02003483#endif
Gerd Hoffmann0f1cb512013-02-22 15:48:05 +01003484
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02003485#ifdef HAVE_CHARDEV_PARPORT
Gerd Hoffmanndc375092013-02-22 16:17:01 +01003486static void qemu_chr_parse_parallel(QemuOpts *opts, ChardevBackend *backend,
3487 Error **errp)
3488{
3489 const char *device = qemu_opt_get(opts, "path");
3490
3491 if (device == NULL) {
3492 error_setg(errp, "chardev: parallel: no device path given");
3493 return;
3494 }
3495 backend->parallel = g_new0(ChardevHostdev, 1);
3496 backend->parallel->device = g_strdup(device);
3497}
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02003498#endif
Gerd Hoffmanndc375092013-02-22 16:17:01 +01003499
Gerd Hoffmann548cbb32013-02-25 11:50:55 +01003500static void qemu_chr_parse_pipe(QemuOpts *opts, ChardevBackend *backend,
3501 Error **errp)
3502{
3503 const char *device = qemu_opt_get(opts, "path");
3504
3505 if (device == NULL) {
3506 error_setg(errp, "chardev: pipe: no device path given");
3507 return;
3508 }
3509 backend->pipe = g_new0(ChardevHostdev, 1);
3510 backend->pipe->device = g_strdup(device);
3511}
3512
Markus Armbruster4f573782013-07-26 16:44:32 +02003513static void qemu_chr_parse_ringbuf(QemuOpts *opts, ChardevBackend *backend,
3514 Error **errp)
Gerd Hoffmann1da48c62013-02-26 16:21:11 +01003515{
3516 int val;
3517
Markus Armbruster3a1da422013-07-26 16:44:34 +02003518 backend->ringbuf = g_new0(ChardevRingbuf, 1);
Gerd Hoffmann1da48c62013-02-26 16:21:11 +01003519
Markus Armbruster0f953052013-06-27 16:22:07 +02003520 val = qemu_opt_get_size(opts, "size", 0);
Gerd Hoffmann1da48c62013-02-26 16:21:11 +01003521 if (val != 0) {
Markus Armbruster3a1da422013-07-26 16:44:34 +02003522 backend->ringbuf->has_size = true;
3523 backend->ringbuf->size = val;
Gerd Hoffmann1da48c62013-02-26 16:21:11 +01003524 }
3525}
3526
Gerd Hoffmannbb6fb7c2013-06-24 08:39:54 +02003527static void qemu_chr_parse_mux(QemuOpts *opts, ChardevBackend *backend,
3528 Error **errp)
3529{
3530 const char *chardev = qemu_opt_get(opts, "chardev");
3531
3532 if (chardev == NULL) {
3533 error_setg(errp, "chardev: mux: no chardev given");
3534 return;
3535 }
3536 backend->mux = g_new0(ChardevMux, 1);
3537 backend->mux->chardev = g_strdup(chardev);
3538}
3539
Peter Maydelldafd3252014-09-02 11:24:13 +01003540static void qemu_chr_parse_socket(QemuOpts *opts, ChardevBackend *backend,
3541 Error **errp)
3542{
3543 bool is_listen = qemu_opt_get_bool(opts, "server", false);
3544 bool is_waitconnect = is_listen && qemu_opt_get_bool(opts, "wait", true);
3545 bool is_telnet = qemu_opt_get_bool(opts, "telnet", false);
3546 bool do_nodelay = !qemu_opt_get_bool(opts, "delay", true);
Corey Minyard5dd1f022014-10-02 11:17:37 -05003547 int64_t reconnect = qemu_opt_get_number(opts, "reconnect", 0);
Peter Maydelldafd3252014-09-02 11:24:13 +01003548 const char *path = qemu_opt_get(opts, "path");
3549 const char *host = qemu_opt_get(opts, "host");
3550 const char *port = qemu_opt_get(opts, "port");
3551 SocketAddress *addr;
3552
3553 if (!path) {
3554 if (!host) {
3555 error_setg(errp, "chardev: socket: no host given");
3556 return;
3557 }
3558 if (!port) {
3559 error_setg(errp, "chardev: socket: no port given");
3560 return;
3561 }
3562 }
3563
3564 backend->socket = g_new0(ChardevSocket, 1);
3565
3566 backend->socket->has_nodelay = true;
3567 backend->socket->nodelay = do_nodelay;
3568 backend->socket->has_server = true;
3569 backend->socket->server = is_listen;
3570 backend->socket->has_telnet = true;
3571 backend->socket->telnet = is_telnet;
3572 backend->socket->has_wait = true;
3573 backend->socket->wait = is_waitconnect;
Corey Minyard5dd1f022014-10-02 11:17:37 -05003574 backend->socket->has_reconnect = true;
3575 backend->socket->reconnect = reconnect;
Peter Maydelldafd3252014-09-02 11:24:13 +01003576
3577 addr = g_new0(SocketAddress, 1);
3578 if (path) {
3579 addr->kind = SOCKET_ADDRESS_KIND_UNIX;
3580 addr->q_unix = g_new0(UnixSocketAddress, 1);
3581 addr->q_unix->path = g_strdup(path);
3582 } else {
3583 addr->kind = SOCKET_ADDRESS_KIND_INET;
3584 addr->inet = g_new0(InetSocketAddress, 1);
3585 addr->inet->host = g_strdup(host);
3586 addr->inet->port = g_strdup(port);
3587 addr->inet->has_to = qemu_opt_get(opts, "to");
3588 addr->inet->to = qemu_opt_get_number(opts, "to", 0);
3589 addr->inet->has_ipv4 = qemu_opt_get(opts, "ipv4");
3590 addr->inet->ipv4 = qemu_opt_get_bool(opts, "ipv4", 0);
3591 addr->inet->has_ipv6 = qemu_opt_get(opts, "ipv6");
3592 addr->inet->ipv6 = qemu_opt_get_bool(opts, "ipv6", 0);
3593 }
3594 backend->socket->addr = addr;
3595}
3596
Peter Maydell90a14bf2014-09-02 11:24:15 +01003597static void qemu_chr_parse_udp(QemuOpts *opts, ChardevBackend *backend,
3598 Error **errp)
3599{
3600 const char *host = qemu_opt_get(opts, "host");
3601 const char *port = qemu_opt_get(opts, "port");
3602 const char *localaddr = qemu_opt_get(opts, "localaddr");
3603 const char *localport = qemu_opt_get(opts, "localport");
3604 bool has_local = false;
3605 SocketAddress *addr;
3606
3607 if (host == NULL || strlen(host) == 0) {
3608 host = "localhost";
3609 }
3610 if (port == NULL || strlen(port) == 0) {
3611 error_setg(errp, "chardev: udp: remote port not specified");
3612 return;
3613 }
3614 if (localport == NULL || strlen(localport) == 0) {
3615 localport = "0";
3616 } else {
3617 has_local = true;
3618 }
3619 if (localaddr == NULL || strlen(localaddr) == 0) {
3620 localaddr = "";
3621 } else {
3622 has_local = true;
3623 }
3624
3625 backend->udp = g_new0(ChardevUdp, 1);
3626
3627 addr = g_new0(SocketAddress, 1);
3628 addr->kind = SOCKET_ADDRESS_KIND_INET;
3629 addr->inet = g_new0(InetSocketAddress, 1);
3630 addr->inet->host = g_strdup(host);
3631 addr->inet->port = g_strdup(port);
3632 addr->inet->has_ipv4 = qemu_opt_get(opts, "ipv4");
3633 addr->inet->ipv4 = qemu_opt_get_bool(opts, "ipv4", 0);
3634 addr->inet->has_ipv6 = qemu_opt_get(opts, "ipv6");
3635 addr->inet->ipv6 = qemu_opt_get_bool(opts, "ipv6", 0);
3636 backend->udp->remote = addr;
3637
3638 if (has_local) {
3639 backend->udp->has_local = true;
3640 addr = g_new0(SocketAddress, 1);
3641 addr->kind = SOCKET_ADDRESS_KIND_INET;
3642 addr->inet = g_new0(InetSocketAddress, 1);
3643 addr->inet->host = g_strdup(localaddr);
3644 addr->inet->port = g_strdup(localport);
3645 backend->udp->local = addr;
3646 }
3647}
3648
Anthony Liguorid654f342013-03-05 23:21:28 +05303649typedef struct CharDriver {
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003650 const char *name;
Gerd Hoffmann99aec012013-06-24 08:39:52 +02003651 ChardevBackendKind kind;
Gerd Hoffmann2c5f4882013-02-21 11:39:12 +01003652 void (*parse)(QemuOpts *opts, ChardevBackend *backend, Error **errp);
Paolo Bonzini4ca17282015-09-29 14:55:59 +02003653 CharDriverState *(*create)(const char *id, ChardevBackend *backend,
3654 ChardevReturn *ret, Error **errp);
Anthony Liguorid654f342013-03-05 23:21:28 +05303655} CharDriver;
3656
3657static GSList *backends;
3658
Peter Maydelle4d50d42014-09-02 11:24:17 +01003659void register_char_driver(const char *name, ChardevBackendKind kind,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02003660 void (*parse)(QemuOpts *opts, ChardevBackend *backend, Error **errp),
3661 CharDriverState *(*create)(const char *id, ChardevBackend *backend,
3662 ChardevReturn *ret, Error **errp))
Gerd Hoffmann2c5f4882013-02-21 11:39:12 +01003663{
3664 CharDriver *s;
3665
3666 s = g_malloc0(sizeof(*s));
3667 s->name = g_strdup(name);
3668 s->kind = kind;
3669 s->parse = parse;
Paolo Bonzini4ca17282015-09-29 14:55:59 +02003670 s->create = create;
Gerd Hoffmann2c5f4882013-02-21 11:39:12 +01003671
3672 backends = g_slist_append(backends, s);
3673}
3674
Anthony Liguorif69554b2011-08-15 11:17:37 -05003675CharDriverState *qemu_chr_new_from_opts(QemuOpts *opts,
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003676 void (*init)(struct CharDriverState *s),
3677 Error **errp)
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003678{
Markus Armbruster0aff6372014-05-19 18:57:35 +02003679 Error *local_err = NULL;
Anthony Liguorid654f342013-03-05 23:21:28 +05303680 CharDriver *cd;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003681 CharDriverState *chr;
Anthony Liguorid654f342013-03-05 23:21:28 +05303682 GSList *i;
Peter Maydella61ae7f2014-09-02 11:24:16 +01003683 ChardevReturn *ret = NULL;
3684 ChardevBackend *backend;
3685 const char *id = qemu_opts_id(opts);
3686 char *bid = NULL;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003687
Peter Maydella61ae7f2014-09-02 11:24:16 +01003688 if (id == NULL) {
Markus Armbruster312fd5f2013-02-08 21:22:16 +01003689 error_setg(errp, "chardev: no id specified");
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003690 goto err;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003691 }
3692
Stefan Hajnoczi1bbd1852011-01-22 13:07:26 +00003693 if (qemu_opt_get(opts, "backend") == NULL) {
Markus Armbruster312fd5f2013-02-08 21:22:16 +01003694 error_setg(errp, "chardev: \"%s\" missing backend",
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003695 qemu_opts_id(opts));
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003696 goto err;
Stefan Hajnoczi1bbd1852011-01-22 13:07:26 +00003697 }
Anthony Liguorid654f342013-03-05 23:21:28 +05303698 for (i = backends; i; i = i->next) {
3699 cd = i->data;
3700
3701 if (strcmp(cd->name, qemu_opt_get(opts, "backend")) == 0) {
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003702 break;
Anthony Liguorid654f342013-03-05 23:21:28 +05303703 }
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003704 }
Anthony Liguorid654f342013-03-05 23:21:28 +05303705 if (i == NULL) {
Markus Armbruster312fd5f2013-02-08 21:22:16 +01003706 error_setg(errp, "chardev: backend \"%s\" not found",
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003707 qemu_opt_get(opts, "backend"));
Gerd Hoffmanne6682872013-06-24 08:39:51 +02003708 goto err;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003709 }
3710
Peter Maydella61ae7f2014-09-02 11:24:16 +01003711 backend = g_new0(ChardevBackend, 1);
Gerd Hoffmann7591c5c2009-09-10 10:58:50 +02003712
3713 if (qemu_opt_get_bool(opts, "mux", 0)) {
Peter Maydella61ae7f2014-09-02 11:24:16 +01003714 bid = g_strdup_printf("%s-base", id);
Gerd Hoffmann7591c5c2009-09-10 10:58:50 +02003715 }
Peter Maydella61ae7f2014-09-02 11:24:16 +01003716
3717 chr = NULL;
3718 backend->kind = cd->kind;
3719 if (cd->parse) {
3720 cd->parse(opts, backend, &local_err);
3721 if (local_err) {
3722 error_propagate(errp, local_err);
3723 goto qapi_out;
3724 }
3725 }
3726 ret = qmp_chardev_add(bid ? bid : id, backend, errp);
3727 if (!ret) {
3728 goto qapi_out;
3729 }
3730
3731 if (bid) {
3732 qapi_free_ChardevBackend(backend);
3733 qapi_free_ChardevReturn(ret);
3734 backend = g_new0(ChardevBackend, 1);
3735 backend->mux = g_new0(ChardevMux, 1);
3736 backend->kind = CHARDEV_BACKEND_KIND_MUX;
3737 backend->mux->chardev = g_strdup(bid);
3738 ret = qmp_chardev_add(id, backend, errp);
3739 if (!ret) {
3740 chr = qemu_chr_find(bid);
3741 qemu_chr_delete(chr);
3742 chr = NULL;
3743 goto qapi_out;
3744 }
3745 }
3746
3747 chr = qemu_chr_find(id);
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003748 chr->opts = opts;
Peter Maydella61ae7f2014-09-02 11:24:16 +01003749
3750qapi_out:
3751 qapi_free_ChardevBackend(backend);
3752 qapi_free_ChardevReturn(ret);
3753 g_free(bid);
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003754 return chr;
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003755
3756err:
3757 qemu_opts_del(opts);
3758 return NULL;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003759}
3760
Anthony Liguori27143a42011-08-15 11:17:36 -05003761CharDriverState *qemu_chr_new(const char *label, const char *filename, void (*init)(struct CharDriverState *s))
aliguori6f97dba2008-10-31 18:49:55 +00003762{
3763 const char *p;
3764 CharDriverState *chr;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003765 QemuOpts *opts;
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003766 Error *err = NULL;
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003767
Gerd Hoffmannc845f402009-09-10 10:58:52 +02003768 if (strstart(filename, "chardev:", &p)) {
3769 return qemu_chr_find(p);
3770 }
3771
Gerd Hoffmann191bc012009-09-10 10:58:35 +02003772 opts = qemu_chr_parse_compat(label, filename);
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003773 if (!opts)
3774 return NULL;
aliguori6f97dba2008-10-31 18:49:55 +00003775
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003776 chr = qemu_chr_new_from_opts(opts, init, &err);
Markus Armbruster84d18f02014-01-30 15:07:28 +01003777 if (err) {
Markus Armbruster565f65d2015-02-12 13:55:05 +01003778 error_report_err(err);
Gerd Hoffmannbd2d80b2012-10-15 09:28:05 +02003779 }
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003780 if (chr && qemu_opt_get_bool(opts, "mux", 0)) {
Hans de Goede456d6062013-03-27 20:29:40 +01003781 qemu_chr_fe_claim_no_fail(chr);
Gerd Hoffmann7e1b35b2009-09-10 10:58:51 +02003782 monitor_init(chr, MONITOR_USE_READLINE);
aliguori6f97dba2008-10-31 18:49:55 +00003783 }
3784 return chr;
3785}
3786
Anthony Liguori15f31512011-08-15 11:17:35 -05003787void qemu_chr_fe_set_echo(struct CharDriverState *chr, bool echo)
Paolo Bonzinic48855e2010-12-23 13:42:48 +01003788{
3789 if (chr->chr_set_echo) {
3790 chr->chr_set_echo(chr, echo);
3791 }
3792}
3793
Hans de Goede8e25daa2013-03-26 11:07:57 +01003794void qemu_chr_fe_set_open(struct CharDriverState *chr, int fe_open)
Hans de Goede7c32c4f2011-03-24 11:12:02 +01003795{
Hans de Goede8e25daa2013-03-26 11:07:57 +01003796 if (chr->fe_open == fe_open) {
Hans de Goedec0c4bd22013-03-26 11:07:55 +01003797 return;
3798 }
Hans de Goede8e25daa2013-03-26 11:07:57 +01003799 chr->fe_open = fe_open;
Hans de Goede574b7112013-03-26 11:07:58 +01003800 if (chr->chr_set_fe_open) {
3801 chr->chr_set_fe_open(chr, fe_open);
Hans de Goede7c32c4f2011-03-24 11:12:02 +01003802 }
3803}
3804
Marc-André Lureaud61b0c92013-12-01 22:23:39 +01003805void qemu_chr_fe_event(struct CharDriverState *chr, int event)
3806{
3807 if (chr->chr_fe_event) {
3808 chr->chr_fe_event(chr, event);
3809 }
3810}
3811
Kevin Wolf2c8a5942013-03-19 13:38:09 +01003812int qemu_chr_fe_add_watch(CharDriverState *s, GIOCondition cond,
3813 GIOFunc func, void *user_data)
Anthony Liguori23673ca2013-03-05 23:21:23 +05303814{
3815 GSource *src;
3816 guint tag;
3817
3818 if (s->chr_add_watch == NULL) {
3819 return -ENOSYS;
3820 }
3821
3822 src = s->chr_add_watch(s, cond);
Paolo Bonzini62c339c2014-07-24 16:08:04 +02003823 if (!src) {
3824 return -EINVAL;
3825 }
3826
Anthony Liguori23673ca2013-03-05 23:21:23 +05303827 g_source_set_callback(src, (GSourceFunc)func, user_data, NULL);
3828 tag = g_source_attach(src, NULL);
3829 g_source_unref(src);
3830
3831 return tag;
3832}
3833
Hans de Goede44c473d2013-03-27 20:29:39 +01003834int qemu_chr_fe_claim(CharDriverState *s)
3835{
3836 if (s->avail_connections < 1) {
3837 return -1;
3838 }
3839 s->avail_connections--;
3840 return 0;
3841}
3842
3843void qemu_chr_fe_claim_no_fail(CharDriverState *s)
3844{
3845 if (qemu_chr_fe_claim(s) != 0) {
3846 fprintf(stderr, "%s: error chardev \"%s\" already used\n",
3847 __func__, s->label);
3848 exit(1);
3849 }
3850}
3851
3852void qemu_chr_fe_release(CharDriverState *s)
3853{
3854 s->avail_connections++;
3855}
3856
Anthony Liguori70f24fb2011-08-15 11:17:38 -05003857void qemu_chr_delete(CharDriverState *chr)
aliguori6f97dba2008-10-31 18:49:55 +00003858{
Blue Swirl72cf2d42009-09-12 07:36:22 +00003859 QTAILQ_REMOVE(&chardevs, chr, next);
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003860 if (chr->chr_close) {
aliguori6f97dba2008-10-31 18:49:55 +00003861 chr->chr_close(chr);
Gerd Hoffmann2274ae92012-10-15 09:30:59 +02003862 }
Anthony Liguori7267c092011-08-20 22:09:37 -05003863 g_free(chr->filename);
3864 g_free(chr->label);
Markus Armbruster4ad60882014-12-03 11:28:02 +01003865 qemu_opts_del(chr->opts);
Anthony Liguori7267c092011-08-20 22:09:37 -05003866 g_free(chr);
aliguori6f97dba2008-10-31 18:49:55 +00003867}
3868
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -03003869ChardevInfoList *qmp_query_chardev(Error **errp)
aliguori6f97dba2008-10-31 18:49:55 +00003870{
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -03003871 ChardevInfoList *chr_list = NULL;
aliguori6f97dba2008-10-31 18:49:55 +00003872 CharDriverState *chr;
3873
Blue Swirl72cf2d42009-09-12 07:36:22 +00003874 QTAILQ_FOREACH(chr, &chardevs, next) {
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -03003875 ChardevInfoList *info = g_malloc0(sizeof(*info));
3876 info->value = g_malloc0(sizeof(*info->value));
3877 info->value->label = g_strdup(chr->label);
3878 info->value->filename = g_strdup(chr->filename);
Laszlo Ersek32a97ea2014-06-26 17:50:03 +02003879 info->value->frontend_open = chr->fe_open;
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -03003880
3881 info->next = chr_list;
3882 chr_list = info;
aliguori6f97dba2008-10-31 18:49:55 +00003883 }
Luiz Capitulino588b3832009-12-10 17:16:08 -02003884
Luiz Capitulinoc5a415a2011-09-14 16:05:49 -03003885 return chr_list;
aliguori6f97dba2008-10-31 18:49:55 +00003886}
Gerd Hoffmannc845f402009-09-10 10:58:52 +02003887
Martin Kletzander77d1c3c2014-02-01 12:52:42 +01003888ChardevBackendInfoList *qmp_query_chardev_backends(Error **errp)
3889{
3890 ChardevBackendInfoList *backend_list = NULL;
3891 CharDriver *c = NULL;
3892 GSList *i = NULL;
3893
3894 for (i = backends; i; i = i->next) {
3895 ChardevBackendInfoList *info = g_malloc0(sizeof(*info));
3896 c = i->data;
3897 info->value = g_malloc0(sizeof(*info->value));
3898 info->value->name = g_strdup(c->name);
3899
3900 info->next = backend_list;
3901 backend_list = info;
3902 }
3903
3904 return backend_list;
3905}
3906
Gerd Hoffmannc845f402009-09-10 10:58:52 +02003907CharDriverState *qemu_chr_find(const char *name)
3908{
3909 CharDriverState *chr;
3910
Blue Swirl72cf2d42009-09-12 07:36:22 +00003911 QTAILQ_FOREACH(chr, &chardevs, next) {
Gerd Hoffmannc845f402009-09-10 10:58:52 +02003912 if (strcmp(chr->label, name) != 0)
3913 continue;
3914 return chr;
3915 }
3916 return NULL;
3917}
Anthony Liguori0beb4942011-12-22 15:29:25 -06003918
3919/* Get a character (serial) device interface. */
3920CharDriverState *qemu_char_get_next_serial(void)
3921{
3922 static int next_serial;
Hans de Goede456d6062013-03-27 20:29:40 +01003923 CharDriverState *chr;
Anthony Liguori0beb4942011-12-22 15:29:25 -06003924
3925 /* FIXME: This function needs to go away: use chardev properties! */
Hans de Goede456d6062013-03-27 20:29:40 +01003926
3927 while (next_serial < MAX_SERIAL_PORTS && serial_hds[next_serial]) {
3928 chr = serial_hds[next_serial++];
3929 qemu_chr_fe_claim_no_fail(chr);
3930 return chr;
3931 }
3932 return NULL;
Anthony Liguori0beb4942011-12-22 15:29:25 -06003933}
3934
Paolo Bonzini4d454572012-11-26 16:03:42 +01003935QemuOptsList qemu_chardev_opts = {
3936 .name = "chardev",
3937 .implied_opt_name = "backend",
3938 .head = QTAILQ_HEAD_INITIALIZER(qemu_chardev_opts.head),
3939 .desc = {
3940 {
3941 .name = "backend",
3942 .type = QEMU_OPT_STRING,
3943 },{
3944 .name = "path",
3945 .type = QEMU_OPT_STRING,
3946 },{
3947 .name = "host",
3948 .type = QEMU_OPT_STRING,
3949 },{
3950 .name = "port",
3951 .type = QEMU_OPT_STRING,
3952 },{
3953 .name = "localaddr",
3954 .type = QEMU_OPT_STRING,
3955 },{
3956 .name = "localport",
3957 .type = QEMU_OPT_STRING,
3958 },{
3959 .name = "to",
3960 .type = QEMU_OPT_NUMBER,
3961 },{
3962 .name = "ipv4",
3963 .type = QEMU_OPT_BOOL,
3964 },{
3965 .name = "ipv6",
3966 .type = QEMU_OPT_BOOL,
3967 },{
3968 .name = "wait",
3969 .type = QEMU_OPT_BOOL,
3970 },{
3971 .name = "server",
3972 .type = QEMU_OPT_BOOL,
3973 },{
3974 .name = "delay",
3975 .type = QEMU_OPT_BOOL,
3976 },{
Corey Minyard5dd1f022014-10-02 11:17:37 -05003977 .name = "reconnect",
3978 .type = QEMU_OPT_NUMBER,
3979 },{
Paolo Bonzini4d454572012-11-26 16:03:42 +01003980 .name = "telnet",
3981 .type = QEMU_OPT_BOOL,
3982 },{
3983 .name = "width",
3984 .type = QEMU_OPT_NUMBER,
3985 },{
3986 .name = "height",
3987 .type = QEMU_OPT_NUMBER,
3988 },{
3989 .name = "cols",
3990 .type = QEMU_OPT_NUMBER,
3991 },{
3992 .name = "rows",
3993 .type = QEMU_OPT_NUMBER,
3994 },{
3995 .name = "mux",
3996 .type = QEMU_OPT_BOOL,
3997 },{
3998 .name = "signal",
3999 .type = QEMU_OPT_BOOL,
4000 },{
4001 .name = "name",
4002 .type = QEMU_OPT_STRING,
4003 },{
4004 .name = "debug",
4005 .type = QEMU_OPT_NUMBER,
Lei Li51767e72013-01-25 00:03:19 +08004006 },{
Markus Armbruster3949e592013-02-06 21:27:24 +01004007 .name = "size",
Markus Armbrusterde1cc362013-02-06 21:27:25 +01004008 .type = QEMU_OPT_SIZE,
Gerd Hoffmannbb6fb7c2013-06-24 08:39:54 +02004009 },{
4010 .name = "chardev",
4011 .type = QEMU_OPT_STRING,
Paolo Bonzini4d454572012-11-26 16:03:42 +01004012 },
4013 { /* end of list */ }
4014 },
4015};
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004016
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004017#ifdef _WIN32
4018
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004019static CharDriverState *qmp_chardev_open_file(const char *id,
4020 ChardevBackend *backend,
4021 ChardevReturn *ret,
4022 Error **errp)
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004023{
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004024 ChardevFile *file = backend->file;
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004025 HANDLE out;
4026
Gerd Hoffmanne859eda2013-06-24 08:39:47 +02004027 if (file->has_in) {
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004028 error_setg(errp, "input file not supported");
4029 return NULL;
4030 }
4031
4032 out = CreateFile(file->out, GENERIC_WRITE, FILE_SHARE_READ, NULL,
4033 OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL, NULL);
4034 if (out == INVALID_HANDLE_VALUE) {
4035 error_setg(errp, "open %s failed", file->out);
4036 return NULL;
4037 }
4038 return qemu_chr_open_win_file(out);
4039}
4040
Paolo Bonzini6511d392015-09-29 15:08:05 +02004041static CharDriverState *qmp_chardev_open_serial(const char *id,
4042 ChardevBackend *backend,
4043 ChardevReturn *ret,
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004044 Error **errp)
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004045{
Paolo Bonzini6511d392015-09-29 15:08:05 +02004046 ChardevHostdev *serial = backend->serial;
4047 return qemu_chr_open_win_path(serial->device, errp);
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004048}
4049
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004050#else /* WIN32 */
4051
4052static int qmp_chardev_open_file_source(char *src, int flags,
4053 Error **errp)
4054{
4055 int fd = -1;
4056
4057 TFR(fd = qemu_open(src, flags, 0666));
4058 if (fd == -1) {
Gerd Hoffmann20c39762013-06-24 08:39:48 +02004059 error_setg_file_open(errp, errno, src);
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004060 }
4061 return fd;
4062}
4063
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004064static CharDriverState *qmp_chardev_open_file(const char *id,
4065 ChardevBackend *backend,
4066 ChardevReturn *ret,
4067 Error **errp)
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004068{
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004069 ChardevFile *file = backend->file;
Markus Armbruster5f758362014-05-19 18:57:34 +02004070 int flags, in = -1, out;
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004071
4072 flags = O_WRONLY | O_TRUNC | O_CREAT | O_BINARY;
4073 out = qmp_chardev_open_file_source(file->out, flags, errp);
Markus Armbruster5f758362014-05-19 18:57:34 +02004074 if (out < 0) {
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004075 return NULL;
4076 }
4077
Gerd Hoffmanne859eda2013-06-24 08:39:47 +02004078 if (file->has_in) {
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004079 flags = O_RDONLY;
4080 in = qmp_chardev_open_file_source(file->in, flags, errp);
Markus Armbruster5f758362014-05-19 18:57:34 +02004081 if (in < 0) {
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004082 qemu_close(out);
4083 return NULL;
4084 }
4085 }
4086
4087 return qemu_chr_open_fd(in, out);
4088}
4089
Paolo Bonzinid809ab92015-10-12 09:46:23 +02004090#ifdef HAVE_CHARDEV_SERIAL
Paolo Bonzini6511d392015-09-29 15:08:05 +02004091static CharDriverState *qmp_chardev_open_serial(const char *id,
4092 ChardevBackend *backend,
4093 ChardevReturn *ret,
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004094 Error **errp)
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004095{
Paolo Bonzini6511d392015-09-29 15:08:05 +02004096 ChardevHostdev *serial = backend->serial;
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004097 int fd;
4098
4099 fd = qmp_chardev_open_file_source(serial->device, O_RDWR, errp);
Markus Armbruster5f758362014-05-19 18:57:34 +02004100 if (fd < 0) {
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004101 return NULL;
4102 }
Stefan Hajnoczif9e8cac2013-03-27 10:10:43 +01004103 qemu_set_nonblock(fd);
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004104 return qemu_chr_open_tty_fd(fd);
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004105}
Paolo Bonzini6511d392015-09-29 15:08:05 +02004106#endif
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004107
Paolo Bonzinid809ab92015-10-12 09:46:23 +02004108#ifdef HAVE_CHARDEV_PARPORT
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02004109static CharDriverState *qmp_chardev_open_parallel(const char *id,
4110 ChardevBackend *backend,
4111 ChardevReturn *ret,
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004112 Error **errp)
4113{
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02004114 ChardevHostdev *parallel = backend->parallel;
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004115 int fd;
4116
4117 fd = qmp_chardev_open_file_source(parallel->device, O_RDWR, errp);
Markus Armbruster5f758362014-05-19 18:57:34 +02004118 if (fd < 0) {
Markus Armbrusterd36b2b92013-02-13 15:54:16 +01004119 return NULL;
4120 }
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02004121 return qemu_chr_open_pp_fd(fd, errp);
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004122}
Paolo Bonzinid809ab92015-10-12 09:46:23 +02004123#endif
Gerd Hoffmannd59044e2012-12-19 13:50:29 +01004124
Gerd Hoffmannffbdbe52012-12-19 13:13:57 +01004125#endif /* WIN32 */
4126
Corey Minyard5008e5b2014-10-08 07:11:55 -05004127static void socket_try_connect(CharDriverState *chr)
4128{
4129 Error *err = NULL;
4130
4131 if (!qemu_chr_open_socket_fd(chr, &err)) {
4132 check_report_connect_error(chr, err);
4133 }
4134}
4135
Corey Minyard5dd1f022014-10-02 11:17:37 -05004136static gboolean socket_reconnect_timeout(gpointer opaque)
4137{
4138 CharDriverState *chr = opaque;
4139 TCPCharDriver *s = chr->opaque;
Corey Minyard5dd1f022014-10-02 11:17:37 -05004140
4141 s->reconnect_timer = 0;
4142
4143 if (chr->be_open) {
4144 return false;
4145 }
4146
Corey Minyard5008e5b2014-10-08 07:11:55 -05004147 socket_try_connect(chr);
Corey Minyard5dd1f022014-10-02 11:17:37 -05004148
4149 return false;
4150}
4151
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004152static CharDriverState *qmp_chardev_open_socket(ChardevSocket *sock,
4153 Error **errp)
4154{
Corey Minyard43ded1a2014-10-02 11:17:34 -05004155 CharDriverState *chr;
4156 TCPCharDriver *s;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004157 SocketAddress *addr = sock->addr;
4158 bool do_nodelay = sock->has_nodelay ? sock->nodelay : false;
4159 bool is_listen = sock->has_server ? sock->server : true;
4160 bool is_telnet = sock->has_telnet ? sock->telnet : false;
4161 bool is_waitconnect = sock->has_wait ? sock->wait : false;
Corey Minyard5dd1f022014-10-02 11:17:37 -05004162 int64_t reconnect = sock->has_reconnect ? sock->reconnect : 0;
Corey Minyard43ded1a2014-10-02 11:17:34 -05004163
4164 chr = qemu_chr_alloc();
Markus Armbruster2d528d42015-09-14 13:54:03 +02004165 s = g_new0(TCPCharDriver, 1);
Corey Minyard43ded1a2014-10-02 11:17:34 -05004166
4167 s->fd = -1;
4168 s->listen_fd = -1;
4169 s->is_unix = addr->kind == SOCKET_ADDRESS_KIND_UNIX;
Corey Minyardcfb429c2014-10-02 11:17:35 -05004170 s->is_listen = is_listen;
4171 s->is_telnet = is_telnet;
Corey Minyard43ded1a2014-10-02 11:17:34 -05004172 s->do_nodelay = do_nodelay;
Corey Minyardcfb429c2014-10-02 11:17:35 -05004173 qapi_copy_SocketAddress(&s->addr, sock->addr);
Corey Minyard43ded1a2014-10-02 11:17:34 -05004174
4175 chr->opaque = s;
4176 chr->chr_write = tcp_chr_write;
4177 chr->chr_sync_read = tcp_chr_sync_read;
4178 chr->chr_close = tcp_chr_close;
4179 chr->get_msgfds = tcp_get_msgfds;
4180 chr->set_msgfds = tcp_set_msgfds;
4181 chr->chr_add_client = tcp_chr_add_client;
4182 chr->chr_add_watch = tcp_chr_add_watch;
4183 chr->chr_update_read_handler = tcp_chr_update_read_handler;
4184 /* be isn't opened until we get a connection */
4185 chr->explicit_be_open = true;
4186
4187 chr->filename = g_malloc(CHR_MAX_FILENAME_SIZE);
Corey Minyard16cc4ff2014-10-02 11:17:36 -05004188 SocketAddress_to_str(chr->filename, CHR_MAX_FILENAME_SIZE, "disconnected:",
4189 addr, is_listen, is_telnet);
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004190
4191 if (is_listen) {
Corey Minyard43ded1a2014-10-02 11:17:34 -05004192 if (is_telnet) {
4193 s->do_telnetopt = 1;
4194 }
Corey Minyard5dd1f022014-10-02 11:17:37 -05004195 } else if (reconnect > 0) {
4196 s->reconnect_time = reconnect;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004197 }
Corey Minyard43ded1a2014-10-02 11:17:34 -05004198
Corey Minyard5008e5b2014-10-08 07:11:55 -05004199 if (s->reconnect_time) {
4200 socket_try_connect(chr);
4201 } else if (!qemu_chr_open_socket_fd(chr, errp)) {
4202 g_free(s);
4203 g_free(chr->filename);
4204 g_free(chr);
4205 return NULL;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004206 }
Corey Minyard43ded1a2014-10-02 11:17:34 -05004207
4208 if (is_listen && is_waitconnect) {
4209 fprintf(stderr, "QEMU waiting for connection on: %s\n",
4210 chr->filename);
4211 tcp_chr_accept(s->listen_chan, G_IO_IN, chr);
4212 qemu_set_nonblock(s->listen_fd);
4213 }
4214
4215 return chr;
Gerd Hoffmannf6bd5d62012-12-20 13:53:12 +01004216}
4217
Lei Li08d0ab32013-05-20 14:51:03 +08004218static CharDriverState *qmp_chardev_open_udp(ChardevUdp *udp,
4219 Error **errp)
Gerd Hoffmann3ecc0592013-02-27 14:10:47 +01004220{
4221 int fd;
4222
Lei Li08d0ab32013-05-20 14:51:03 +08004223 fd = socket_dgram(udp->remote, udp->local, errp);
Markus Armbruster5f758362014-05-19 18:57:34 +02004224 if (fd < 0) {
Gerd Hoffmann3ecc0592013-02-27 14:10:47 +01004225 return NULL;
4226 }
4227 return qemu_chr_open_udp_fd(fd);
4228}
4229
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004230ChardevReturn *qmp_chardev_add(const char *id, ChardevBackend *backend,
4231 Error **errp)
4232{
4233 ChardevReturn *ret = g_new0(ChardevReturn, 1);
Gerd Hoffmannedb2fb32013-02-21 16:16:42 +01004234 CharDriverState *base, *chr = NULL;
Paolo Bonzinieaeba652015-09-29 14:54:05 +02004235 Error *local_err = NULL;
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004236 GSList *i;
4237 CharDriver *cd;
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004238
4239 chr = qemu_chr_find(id);
4240 if (chr) {
4241 error_setg(errp, "Chardev '%s' already exists", id);
4242 g_free(ret);
4243 return NULL;
4244 }
4245
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004246 for (i = backends; i; i = i->next) {
4247 cd = i->data;
4248
4249 if (cd->kind == backend->kind && cd->create) {
4250 chr = cd->create(id, backend, ret, &local_err);
4251 if (local_err) {
4252 error_propagate(errp, local_err);
4253 goto out_error;
4254 }
Gerd Hoffmannedb2fb32013-02-21 16:16:42 +01004255 break;
4256 }
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004257 }
4258
Paolo Bonzinieaeba652015-09-29 14:54:05 +02004259 if (chr == NULL) {
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004260 switch (backend->kind) {
4261 case CHARDEV_BACKEND_KIND_FILE:
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004262 abort();
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004263 break;
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004264 case CHARDEV_BACKEND_KIND_SERIAL:
Paolo Bonzini6511d392015-09-29 15:08:05 +02004265 abort();
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004266 break;
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004267 case CHARDEV_BACKEND_KIND_PARALLEL:
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02004268 abort();
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004269 break;
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004270 case CHARDEV_BACKEND_KIND_PIPE:
4271 chr = qemu_chr_open_pipe(backend->pipe);
4272 break;
4273 case CHARDEV_BACKEND_KIND_SOCKET:
4274 chr = qmp_chardev_open_socket(backend->socket, &local_err);
4275 break;
4276 case CHARDEV_BACKEND_KIND_UDP:
4277 chr = qmp_chardev_open_udp(backend->udp, &local_err);
4278 break;
4279#ifdef HAVE_CHARDEV_PTY
4280 case CHARDEV_BACKEND_KIND_PTY:
4281 chr = qemu_chr_open_pty(id, ret);
4282 break;
4283#endif
4284 case CHARDEV_BACKEND_KIND_NULL:
4285 chr = qemu_chr_open_null();
4286 break;
4287 case CHARDEV_BACKEND_KIND_MUX:
4288 base = qemu_chr_find(backend->mux->chardev);
4289 if (base == NULL) {
4290 error_setg(&local_err, "mux: base chardev %s not found",
4291 backend->mux->chardev);
4292 break;
4293 }
4294 chr = qemu_chr_open_mux(base);
4295 break;
4296 case CHARDEV_BACKEND_KIND_MSMOUSE:
4297 chr = qemu_chr_open_msmouse();
4298 break;
4299#ifdef CONFIG_BRLAPI
4300 case CHARDEV_BACKEND_KIND_BRAILLE:
4301 chr = chr_baum_init();
4302 break;
4303#endif
4304 case CHARDEV_BACKEND_KIND_TESTDEV:
4305 chr = chr_testdev_init();
4306 break;
4307 case CHARDEV_BACKEND_KIND_STDIO:
4308 chr = qemu_chr_open_stdio(backend->stdio);
4309 break;
4310#ifdef _WIN32
4311 case CHARDEV_BACKEND_KIND_CONSOLE:
4312 chr = qemu_chr_open_win_con();
4313 break;
4314#endif
4315#ifdef CONFIG_SPICE
4316 case CHARDEV_BACKEND_KIND_SPICEVMC:
4317 chr = qemu_chr_open_spice_vmc(backend->spicevmc->type);
4318 break;
4319 case CHARDEV_BACKEND_KIND_SPICEPORT:
4320 chr = qemu_chr_open_spice_port(backend->spiceport->fqdn);
4321 break;
4322#endif
4323 case CHARDEV_BACKEND_KIND_VC:
4324 chr = vc_init(backend->vc);
4325 break;
4326 case CHARDEV_BACKEND_KIND_RINGBUF:
4327 case CHARDEV_BACKEND_KIND_MEMORY:
4328 chr = qemu_chr_open_ringbuf(backend->ringbuf, &local_err);
4329 break;
4330 default:
4331 error_setg(errp, "unknown chardev backend (%d)", backend->kind);
4332 goto out_error;
Gerd Hoffmann60d95382013-05-27 12:41:24 +02004333 }
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004334
4335 /*
4336 * Character backend open hasn't been fully converted to the Error
4337 * API. Some opens fail without setting an error. Set a generic
4338 * error then.
4339 * TODO full conversion to Error API
4340 */
4341 if (chr == NULL) {
4342 if (local_err) {
4343 error_propagate(errp, local_err);
4344 } else {
4345 error_setg(errp, "Failed to create chardev");
4346 }
4347 goto out_error;
4348 }
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004349 }
Paolo Bonzinieaeba652015-09-29 14:54:05 +02004350
4351 chr->label = g_strdup(id);
4352 chr->avail_connections =
4353 (backend->kind == CHARDEV_BACKEND_KIND_MUX) ? MAX_MUX : 1;
4354 if (!chr->filename) {
4355 chr->filename = g_strdup(ChardevBackendKind_lookup[backend->kind]);
4356 }
4357 if (!chr->explicit_be_open) {
4358 qemu_chr_be_event(chr, CHR_EVENT_OPENED);
4359 }
4360 QTAILQ_INSERT_TAIL(&chardevs, chr, next);
4361 return ret;
4362
4363out_error:
4364 g_free(ret);
4365 return NULL;
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004366}
4367
4368void qmp_chardev_remove(const char *id, Error **errp)
4369{
4370 CharDriverState *chr;
4371
4372 chr = qemu_chr_find(id);
Gonglei8108fd32014-08-11 21:00:55 +08004373 if (chr == NULL) {
Gerd Hoffmannf1a1a352012-12-19 10:33:56 +01004374 error_setg(errp, "Chardev '%s' not found", id);
4375 return;
4376 }
4377 if (chr->chr_can_read || chr->chr_read ||
4378 chr->chr_event || chr->handler_opaque) {
4379 error_setg(errp, "Chardev '%s' is busy", id);
4380 return;
4381 }
4382 qemu_chr_delete(chr);
4383}
Anthony Liguorid654f342013-03-05 23:21:28 +05304384
4385static void register_types(void)
4386{
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004387 register_char_driver("null", CHARDEV_BACKEND_KIND_NULL, NULL,
4388 NULL);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004389 register_char_driver("socket", CHARDEV_BACKEND_KIND_SOCKET,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004390 qemu_chr_parse_socket, NULL);
4391 register_char_driver("udp", CHARDEV_BACKEND_KIND_UDP, qemu_chr_parse_udp,
4392 NULL);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004393 register_char_driver("ringbuf", CHARDEV_BACKEND_KIND_RINGBUF,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004394 qemu_chr_parse_ringbuf, NULL);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004395 register_char_driver("file", CHARDEV_BACKEND_KIND_FILE,
Paolo Bonzinifd5b0362015-09-29 15:06:02 +02004396 qemu_chr_parse_file_out, qmp_chardev_open_file);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004397 register_char_driver("stdio", CHARDEV_BACKEND_KIND_STDIO,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004398 qemu_chr_parse_stdio, NULL);
Paolo Bonzini6511d392015-09-29 15:08:05 +02004399#if defined HAVE_CHARDEV_SERIAL
Peter Maydelle4d50d42014-09-02 11:24:17 +01004400 register_char_driver("serial", CHARDEV_BACKEND_KIND_SERIAL,
Paolo Bonzini6511d392015-09-29 15:08:05 +02004401 qemu_chr_parse_serial, qmp_chardev_open_serial);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004402 register_char_driver("tty", CHARDEV_BACKEND_KIND_SERIAL,
Paolo Bonzini6511d392015-09-29 15:08:05 +02004403 qemu_chr_parse_serial, qmp_chardev_open_serial);
4404#endif
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02004405#ifdef HAVE_CHARDEV_PARPORT
Peter Maydelle4d50d42014-09-02 11:24:17 +01004406 register_char_driver("parallel", CHARDEV_BACKEND_KIND_PARALLEL,
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02004407 qemu_chr_parse_parallel, qmp_chardev_open_parallel);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004408 register_char_driver("parport", CHARDEV_BACKEND_KIND_PARALLEL,
Paolo Bonzini38bfb1a2015-10-12 09:49:28 +02004409 qemu_chr_parse_parallel, qmp_chardev_open_parallel);
4410#endif
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004411 register_char_driver("pty", CHARDEV_BACKEND_KIND_PTY, NULL,
4412 NULL);
4413 register_char_driver("console", CHARDEV_BACKEND_KIND_CONSOLE, NULL,
4414 NULL);
Peter Maydelle4d50d42014-09-02 11:24:17 +01004415 register_char_driver("pipe", CHARDEV_BACKEND_KIND_PIPE,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004416 qemu_chr_parse_pipe, NULL);
4417 register_char_driver("mux", CHARDEV_BACKEND_KIND_MUX, qemu_chr_parse_mux,
4418 NULL);
Markus Armbrusterc11ed962013-07-26 16:44:33 +02004419 /* Bug-compatibility: */
Peter Maydelle4d50d42014-09-02 11:24:17 +01004420 register_char_driver("memory", CHARDEV_BACKEND_KIND_MEMORY,
Paolo Bonzini4ca17282015-09-29 14:55:59 +02004421 qemu_chr_parse_ringbuf, NULL);
Michael Roth7b7ab182013-07-30 13:04:22 -05004422 /* this must be done after machine init, since we register FEs with muxes
4423 * as part of realize functions like serial_isa_realizefn when -nographic
4424 * is specified
4425 */
4426 qemu_add_machine_init_done_notifier(&muxes_realize_notify);
Anthony Liguorid654f342013-03-05 23:21:28 +05304427}
4428
4429type_init(register_types);