9fc53a10f8
If we see EAGAIN, no data was sent over the socket, so we still have to retry sending of msgfds next time. Signed-off-by: linzhecheng <linzhecheng@huawei.com> Signed-off-by: Daniel P. Berrangé <berrange@redhat.com>
1215 lines
36 KiB
C
1215 lines
36 KiB
C
/*
|
|
* QEMU System Emulator
|
|
*
|
|
* Copyright (c) 2003-2008 Fabrice Bellard
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
* THE SOFTWARE.
|
|
*/
|
|
|
|
#include "qemu/osdep.h"
|
|
#include "chardev/char.h"
|
|
#include "io/channel-socket.h"
|
|
#include "io/channel-tls.h"
|
|
#include "io/net-listener.h"
|
|
#include "qemu/error-report.h"
|
|
#include "qemu/option.h"
|
|
#include "qapi/error.h"
|
|
#include "qapi/clone-visitor.h"
|
|
#include "qapi/qapi-visit-sockets.h"
|
|
#include "sysemu/sysemu.h"
|
|
|
|
#include "chardev/char-io.h"
|
|
|
|
/***********************************************************/
|
|
/* TCP Net console */
|
|
|
|
#define TCP_MAX_FDS 16
|
|
|
|
typedef struct {
|
|
char buf[21];
|
|
size_t buflen;
|
|
} TCPChardevTelnetInit;
|
|
|
|
typedef struct {
|
|
Chardev parent;
|
|
QIOChannel *ioc; /* Client I/O channel */
|
|
QIOChannelSocket *sioc; /* Client master channel */
|
|
QIONetListener *listener;
|
|
GSource *hup_source;
|
|
QCryptoTLSCreds *tls_creds;
|
|
int connected;
|
|
int max_size;
|
|
int do_telnetopt;
|
|
int do_nodelay;
|
|
int *read_msgfds;
|
|
size_t read_msgfds_num;
|
|
int *write_msgfds;
|
|
size_t write_msgfds_num;
|
|
|
|
SocketAddress *addr;
|
|
bool is_listen;
|
|
bool is_telnet;
|
|
bool is_tn3270;
|
|
GSource *telnet_source;
|
|
TCPChardevTelnetInit *telnet_init;
|
|
|
|
GSource *reconnect_timer;
|
|
int64_t reconnect_time;
|
|
bool connect_err_reported;
|
|
} SocketChardev;
|
|
|
|
#define SOCKET_CHARDEV(obj) \
|
|
OBJECT_CHECK(SocketChardev, (obj), TYPE_CHARDEV_SOCKET)
|
|
|
|
static gboolean socket_reconnect_timeout(gpointer opaque);
|
|
static void tcp_chr_telnet_init(Chardev *chr);
|
|
|
|
static void tcp_chr_reconn_timer_cancel(SocketChardev *s)
|
|
{
|
|
if (s->reconnect_timer) {
|
|
g_source_destroy(s->reconnect_timer);
|
|
g_source_unref(s->reconnect_timer);
|
|
s->reconnect_timer = NULL;
|
|
}
|
|
}
|
|
|
|
static void qemu_chr_socket_restart_timer(Chardev *chr)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
char *name;
|
|
|
|
assert(s->connected == 0);
|
|
name = g_strdup_printf("chardev-socket-reconnect-%s", chr->label);
|
|
s->reconnect_timer = qemu_chr_timeout_add_ms(chr,
|
|
s->reconnect_time * 1000,
|
|
socket_reconnect_timeout,
|
|
chr);
|
|
g_source_set_name(s->reconnect_timer, name);
|
|
g_free(name);
|
|
}
|
|
|
|
static void check_report_connect_error(Chardev *chr,
|
|
Error *err)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
|
|
if (!s->connect_err_reported) {
|
|
error_report("Unable to connect character device %s: %s",
|
|
chr->label, error_get_pretty(err));
|
|
s->connect_err_reported = true;
|
|
}
|
|
qemu_chr_socket_restart_timer(chr);
|
|
}
|
|
|
|
static void tcp_chr_accept(QIONetListener *listener,
|
|
QIOChannelSocket *cioc,
|
|
void *opaque);
|
|
|
|
static int tcp_chr_read_poll(void *opaque);
|
|
static void tcp_chr_disconnect(Chardev *chr);
|
|
|
|
/* Called with chr_write_lock held. */
|
|
static int tcp_chr_write(Chardev *chr, const uint8_t *buf, int len)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
|
|
if (s->connected) {
|
|
int ret = io_channel_send_full(s->ioc, buf, len,
|
|
s->write_msgfds,
|
|
s->write_msgfds_num);
|
|
|
|
/* free the written msgfds in any cases other than errno==EAGAIN */
|
|
if (EAGAIN != errno && s->write_msgfds_num) {
|
|
g_free(s->write_msgfds);
|
|
s->write_msgfds = 0;
|
|
s->write_msgfds_num = 0;
|
|
}
|
|
|
|
if (ret < 0 && errno != EAGAIN) {
|
|
if (tcp_chr_read_poll(chr) <= 0) {
|
|
tcp_chr_disconnect(chr);
|
|
return len;
|
|
} /* else let the read handler finish it properly */
|
|
}
|
|
|
|
return ret;
|
|
} else {
|
|
/* XXX: indicate an error ? */
|
|
return len;
|
|
}
|
|
}
|
|
|
|
static int tcp_chr_read_poll(void *opaque)
|
|
{
|
|
Chardev *chr = CHARDEV(opaque);
|
|
SocketChardev *s = SOCKET_CHARDEV(opaque);
|
|
if (!s->connected) {
|
|
return 0;
|
|
}
|
|
s->max_size = qemu_chr_be_can_write(chr);
|
|
return s->max_size;
|
|
}
|
|
|
|
static void tcp_chr_process_IAC_bytes(Chardev *chr,
|
|
SocketChardev *s,
|
|
uint8_t *buf, int *size)
|
|
{
|
|
/* Handle any telnet or tn3270 client's basic IAC options.
|
|
* For telnet options, it satisfies char by char mode with no echo.
|
|
* For tn3270 options, it satisfies binary mode with EOR.
|
|
* All IAC options will be removed from the buf and the do_opt
|
|
* pointer will be used to track the state of the width of the
|
|
* IAC information.
|
|
*
|
|
* RFC854: "All TELNET commands consist of at least a two byte sequence.
|
|
* The commands dealing with option negotiation are three byte sequences,
|
|
* the third byte being the code for the option referenced."
|
|
* "IAC BREAK", "IAC IP", "IAC NOP" and the double IAC are two bytes.
|
|
* "IAC SB", "IAC SE" and "IAC EOR" are saved to split up data boundary
|
|
* for tn3270.
|
|
* NOP, Break and Interrupt Process(IP) might be encountered during a TN3270
|
|
* session, and NOP and IP need to be done later.
|
|
*/
|
|
|
|
int i;
|
|
int j = 0;
|
|
|
|
for (i = 0; i < *size; i++) {
|
|
if (s->do_telnetopt > 1) {
|
|
if ((unsigned char)buf[i] == IAC && s->do_telnetopt == 2) {
|
|
/* Double IAC means send an IAC */
|
|
if (j != i) {
|
|
buf[j] = buf[i];
|
|
}
|
|
j++;
|
|
s->do_telnetopt = 1;
|
|
} else {
|
|
if ((unsigned char)buf[i] == IAC_BREAK
|
|
&& s->do_telnetopt == 2) {
|
|
/* Handle IAC break commands by sending a serial break */
|
|
qemu_chr_be_event(chr, CHR_EVENT_BREAK);
|
|
s->do_telnetopt++;
|
|
} else if (s->is_tn3270 && ((unsigned char)buf[i] == IAC_EOR
|
|
|| (unsigned char)buf[i] == IAC_SB
|
|
|| (unsigned char)buf[i] == IAC_SE)
|
|
&& s->do_telnetopt == 2) {
|
|
buf[j++] = IAC;
|
|
buf[j++] = buf[i];
|
|
s->do_telnetopt++;
|
|
} else if (s->is_tn3270 && ((unsigned char)buf[i] == IAC_IP
|
|
|| (unsigned char)buf[i] == IAC_NOP)
|
|
&& s->do_telnetopt == 2) {
|
|
/* TODO: IP and NOP need to be implemented later. */
|
|
s->do_telnetopt++;
|
|
}
|
|
s->do_telnetopt++;
|
|
}
|
|
if (s->do_telnetopt >= 4) {
|
|
s->do_telnetopt = 1;
|
|
}
|
|
} else {
|
|
if ((unsigned char)buf[i] == IAC) {
|
|
s->do_telnetopt = 2;
|
|
} else {
|
|
if (j != i) {
|
|
buf[j] = buf[i];
|
|
}
|
|
j++;
|
|
}
|
|
}
|
|
}
|
|
*size = j;
|
|
}
|
|
|
|
static int tcp_get_msgfds(Chardev *chr, int *fds, int num)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
|
|
int to_copy = (s->read_msgfds_num < num) ? s->read_msgfds_num : num;
|
|
|
|
assert(num <= TCP_MAX_FDS);
|
|
|
|
if (to_copy) {
|
|
int i;
|
|
|
|
memcpy(fds, s->read_msgfds, to_copy * sizeof(int));
|
|
|
|
/* Close unused fds */
|
|
for (i = to_copy; i < s->read_msgfds_num; i++) {
|
|
close(s->read_msgfds[i]);
|
|
}
|
|
|
|
g_free(s->read_msgfds);
|
|
s->read_msgfds = 0;
|
|
s->read_msgfds_num = 0;
|
|
}
|
|
|
|
return to_copy;
|
|
}
|
|
|
|
static int tcp_set_msgfds(Chardev *chr, int *fds, int num)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
|
|
/* clear old pending fd array */
|
|
g_free(s->write_msgfds);
|
|
s->write_msgfds = NULL;
|
|
s->write_msgfds_num = 0;
|
|
|
|
if (!s->connected ||
|
|
!qio_channel_has_feature(s->ioc,
|
|
QIO_CHANNEL_FEATURE_FD_PASS)) {
|
|
return -1;
|
|
}
|
|
|
|
if (num) {
|
|
s->write_msgfds = g_new(int, num);
|
|
memcpy(s->write_msgfds, fds, num * sizeof(int));
|
|
}
|
|
|
|
s->write_msgfds_num = num;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t tcp_chr_recv(Chardev *chr, char *buf, size_t len)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
struct iovec iov = { .iov_base = buf, .iov_len = len };
|
|
int ret;
|
|
size_t i;
|
|
int *msgfds = NULL;
|
|
size_t msgfds_num = 0;
|
|
|
|
if (qio_channel_has_feature(s->ioc, QIO_CHANNEL_FEATURE_FD_PASS)) {
|
|
ret = qio_channel_readv_full(s->ioc, &iov, 1,
|
|
&msgfds, &msgfds_num,
|
|
NULL);
|
|
} else {
|
|
ret = qio_channel_readv_full(s->ioc, &iov, 1,
|
|
NULL, NULL,
|
|
NULL);
|
|
}
|
|
|
|
if (ret == QIO_CHANNEL_ERR_BLOCK) {
|
|
errno = EAGAIN;
|
|
ret = -1;
|
|
} else if (ret == -1) {
|
|
errno = EIO;
|
|
}
|
|
|
|
if (msgfds_num) {
|
|
/* close and clean read_msgfds */
|
|
for (i = 0; i < s->read_msgfds_num; i++) {
|
|
close(s->read_msgfds[i]);
|
|
}
|
|
|
|
if (s->read_msgfds_num) {
|
|
g_free(s->read_msgfds);
|
|
}
|
|
|
|
s->read_msgfds = msgfds;
|
|
s->read_msgfds_num = msgfds_num;
|
|
}
|
|
|
|
for (i = 0; i < s->read_msgfds_num; i++) {
|
|
int fd = s->read_msgfds[i];
|
|
if (fd < 0) {
|
|
continue;
|
|
}
|
|
|
|
/* O_NONBLOCK is preserved across SCM_RIGHTS so reset it */
|
|
qemu_set_block(fd);
|
|
|
|
#ifndef MSG_CMSG_CLOEXEC
|
|
qemu_set_cloexec(fd);
|
|
#endif
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static GSource *tcp_chr_add_watch(Chardev *chr, GIOCondition cond)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
return qio_channel_create_watch(s->ioc, cond);
|
|
}
|
|
|
|
static void tcp_chr_free_connection(Chardev *chr)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
int i;
|
|
|
|
if (s->read_msgfds_num) {
|
|
for (i = 0; i < s->read_msgfds_num; i++) {
|
|
close(s->read_msgfds[i]);
|
|
}
|
|
g_free(s->read_msgfds);
|
|
s->read_msgfds = NULL;
|
|
s->read_msgfds_num = 0;
|
|
}
|
|
|
|
if (s->hup_source != NULL) {
|
|
g_source_destroy(s->hup_source);
|
|
g_source_unref(s->hup_source);
|
|
s->hup_source = NULL;
|
|
}
|
|
|
|
tcp_set_msgfds(chr, NULL, 0);
|
|
remove_fd_in_watch(chr);
|
|
object_unref(OBJECT(s->sioc));
|
|
s->sioc = NULL;
|
|
object_unref(OBJECT(s->ioc));
|
|
s->ioc = NULL;
|
|
g_free(chr->filename);
|
|
chr->filename = NULL;
|
|
s->connected = 0;
|
|
}
|
|
|
|
static char *SocketAddress_to_str(const char *prefix, SocketAddress *addr,
|
|
bool is_listen, bool is_telnet)
|
|
{
|
|
switch (addr->type) {
|
|
case SOCKET_ADDRESS_TYPE_INET:
|
|
return g_strdup_printf("%s%s:%s:%s%s", prefix,
|
|
is_telnet ? "telnet" : "tcp",
|
|
addr->u.inet.host,
|
|
addr->u.inet.port,
|
|
is_listen ? ",server" : "");
|
|
break;
|
|
case SOCKET_ADDRESS_TYPE_UNIX:
|
|
return g_strdup_printf("%sunix:%s%s", prefix,
|
|
addr->u.q_unix.path,
|
|
is_listen ? ",server" : "");
|
|
break;
|
|
case SOCKET_ADDRESS_TYPE_FD:
|
|
return g_strdup_printf("%sfd:%s%s", prefix, addr->u.fd.str,
|
|
is_listen ? ",server" : "");
|
|
break;
|
|
case SOCKET_ADDRESS_TYPE_VSOCK:
|
|
return g_strdup_printf("%svsock:%s:%s", prefix,
|
|
addr->u.vsock.cid,
|
|
addr->u.vsock.port);
|
|
default:
|
|
abort();
|
|
}
|
|
}
|
|
|
|
static void update_disconnected_filename(SocketChardev *s)
|
|
{
|
|
Chardev *chr = CHARDEV(s);
|
|
|
|
g_free(chr->filename);
|
|
chr->filename = SocketAddress_to_str("disconnected:", s->addr,
|
|
s->is_listen, s->is_telnet);
|
|
}
|
|
|
|
/* NB may be called even if tcp_chr_connect has not been
|
|
* reached, due to TLS or telnet initialization failure,
|
|
* so can *not* assume s->connected == true
|
|
*/
|
|
static void tcp_chr_disconnect(Chardev *chr)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
bool emit_close = s->connected;
|
|
|
|
tcp_chr_free_connection(chr);
|
|
|
|
if (s->listener) {
|
|
qio_net_listener_set_client_func_full(s->listener, tcp_chr_accept,
|
|
chr, NULL, chr->gcontext);
|
|
}
|
|
update_disconnected_filename(s);
|
|
if (emit_close) {
|
|
qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
|
|
}
|
|
if (s->reconnect_time) {
|
|
qemu_chr_socket_restart_timer(chr);
|
|
}
|
|
}
|
|
|
|
static gboolean tcp_chr_read(QIOChannel *chan, GIOCondition cond, void *opaque)
|
|
{
|
|
Chardev *chr = CHARDEV(opaque);
|
|
SocketChardev *s = SOCKET_CHARDEV(opaque);
|
|
uint8_t buf[CHR_READ_BUF_LEN];
|
|
int len, size;
|
|
|
|
if (!s->connected || s->max_size <= 0) {
|
|
return TRUE;
|
|
}
|
|
len = sizeof(buf);
|
|
if (len > s->max_size) {
|
|
len = s->max_size;
|
|
}
|
|
size = tcp_chr_recv(chr, (void *)buf, len);
|
|
if (size == 0 || (size == -1 && errno != EAGAIN)) {
|
|
/* connection closed */
|
|
tcp_chr_disconnect(chr);
|
|
} else if (size > 0) {
|
|
if (s->do_telnetopt) {
|
|
tcp_chr_process_IAC_bytes(chr, s, buf, &size);
|
|
}
|
|
if (size > 0) {
|
|
qemu_chr_be_write(chr, buf, size);
|
|
}
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
static gboolean tcp_chr_hup(QIOChannel *channel,
|
|
GIOCondition cond,
|
|
void *opaque)
|
|
{
|
|
Chardev *chr = CHARDEV(opaque);
|
|
tcp_chr_disconnect(chr);
|
|
return G_SOURCE_REMOVE;
|
|
}
|
|
|
|
static int tcp_chr_sync_read(Chardev *chr, const uint8_t *buf, int len)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
int size;
|
|
|
|
if (!s->connected) {
|
|
return 0;
|
|
}
|
|
|
|
qio_channel_set_blocking(s->ioc, true, NULL);
|
|
size = tcp_chr_recv(chr, (void *) buf, len);
|
|
qio_channel_set_blocking(s->ioc, false, NULL);
|
|
if (size == 0) {
|
|
/* connection closed */
|
|
tcp_chr_disconnect(chr);
|
|
}
|
|
|
|
return size;
|
|
}
|
|
|
|
static char *sockaddr_to_str(struct sockaddr_storage *ss, socklen_t ss_len,
|
|
struct sockaddr_storage *ps, socklen_t ps_len,
|
|
bool is_listen, bool is_telnet)
|
|
{
|
|
char shost[NI_MAXHOST], sserv[NI_MAXSERV];
|
|
char phost[NI_MAXHOST], pserv[NI_MAXSERV];
|
|
const char *left = "", *right = "";
|
|
|
|
switch (ss->ss_family) {
|
|
#ifndef _WIN32
|
|
case AF_UNIX:
|
|
return g_strdup_printf("unix:%s%s",
|
|
((struct sockaddr_un *)(ss))->sun_path,
|
|
is_listen ? ",server" : "");
|
|
#endif
|
|
case AF_INET6:
|
|
left = "[";
|
|
right = "]";
|
|
/* fall through */
|
|
case AF_INET:
|
|
getnameinfo((struct sockaddr *) ss, ss_len, shost, sizeof(shost),
|
|
sserv, sizeof(sserv), NI_NUMERICHOST | NI_NUMERICSERV);
|
|
getnameinfo((struct sockaddr *) ps, ps_len, phost, sizeof(phost),
|
|
pserv, sizeof(pserv), NI_NUMERICHOST | NI_NUMERICSERV);
|
|
return g_strdup_printf("%s:%s%s%s:%s%s <-> %s%s%s:%s",
|
|
is_telnet ? "telnet" : "tcp",
|
|
left, shost, right, sserv,
|
|
is_listen ? ",server" : "",
|
|
left, phost, right, pserv);
|
|
|
|
default:
|
|
return g_strdup_printf("unknown");
|
|
}
|
|
}
|
|
|
|
static void tcp_chr_connect(void *opaque)
|
|
{
|
|
Chardev *chr = CHARDEV(opaque);
|
|
SocketChardev *s = SOCKET_CHARDEV(opaque);
|
|
|
|
g_free(chr->filename);
|
|
chr->filename = sockaddr_to_str(
|
|
&s->sioc->localAddr, s->sioc->localAddrLen,
|
|
&s->sioc->remoteAddr, s->sioc->remoteAddrLen,
|
|
s->is_listen, s->is_telnet);
|
|
|
|
s->connected = 1;
|
|
chr->gsource = io_add_watch_poll(chr, s->ioc,
|
|
tcp_chr_read_poll,
|
|
tcp_chr_read,
|
|
chr, chr->gcontext);
|
|
|
|
s->hup_source = qio_channel_create_watch(s->ioc, G_IO_HUP);
|
|
g_source_set_callback(s->hup_source, (GSourceFunc)tcp_chr_hup,
|
|
chr, NULL);
|
|
g_source_attach(s->hup_source, chr->gcontext);
|
|
|
|
qemu_chr_be_event(chr, CHR_EVENT_OPENED);
|
|
}
|
|
|
|
static void tcp_chr_telnet_destroy(SocketChardev *s)
|
|
{
|
|
if (s->telnet_source) {
|
|
g_source_destroy(s->telnet_source);
|
|
g_source_unref(s->telnet_source);
|
|
s->telnet_source = NULL;
|
|
}
|
|
}
|
|
|
|
static void tcp_chr_update_read_handler(Chardev *chr)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
|
|
if (s->listener) {
|
|
/*
|
|
* It's possible that chardev context is changed in
|
|
* qemu_chr_be_update_read_handlers(). Reset it for QIO net
|
|
* listener if there is.
|
|
*/
|
|
qio_net_listener_set_client_func_full(s->listener, tcp_chr_accept,
|
|
chr, NULL, chr->gcontext);
|
|
}
|
|
|
|
if (s->telnet_source) {
|
|
tcp_chr_telnet_init(CHARDEV(s));
|
|
}
|
|
|
|
if (!s->connected) {
|
|
return;
|
|
}
|
|
|
|
remove_fd_in_watch(chr);
|
|
if (s->ioc) {
|
|
chr->gsource = io_add_watch_poll(chr, s->ioc,
|
|
tcp_chr_read_poll,
|
|
tcp_chr_read, chr,
|
|
chr->gcontext);
|
|
}
|
|
}
|
|
|
|
static gboolean tcp_chr_telnet_init_io(QIOChannel *ioc,
|
|
GIOCondition cond G_GNUC_UNUSED,
|
|
gpointer user_data)
|
|
{
|
|
SocketChardev *s = user_data;
|
|
Chardev *chr = CHARDEV(s);
|
|
TCPChardevTelnetInit *init = s->telnet_init;
|
|
ssize_t ret;
|
|
|
|
assert(init);
|
|
|
|
ret = qio_channel_write(ioc, init->buf, init->buflen, NULL);
|
|
if (ret < 0) {
|
|
if (ret == QIO_CHANNEL_ERR_BLOCK) {
|
|
ret = 0;
|
|
} else {
|
|
tcp_chr_disconnect(chr);
|
|
goto end;
|
|
}
|
|
}
|
|
init->buflen -= ret;
|
|
|
|
if (init->buflen == 0) {
|
|
tcp_chr_connect(chr);
|
|
goto end;
|
|
}
|
|
|
|
memmove(init->buf, init->buf + ret, init->buflen);
|
|
|
|
return G_SOURCE_CONTINUE;
|
|
|
|
end:
|
|
g_free(s->telnet_init);
|
|
s->telnet_init = NULL;
|
|
g_source_unref(s->telnet_source);
|
|
s->telnet_source = NULL;
|
|
return G_SOURCE_REMOVE;
|
|
}
|
|
|
|
static void tcp_chr_telnet_init(Chardev *chr)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
TCPChardevTelnetInit *init;
|
|
size_t n = 0;
|
|
|
|
/* Destroy existing task */
|
|
tcp_chr_telnet_destroy(s);
|
|
|
|
if (s->telnet_init) {
|
|
/* We are possibly during a handshake already */
|
|
goto cont;
|
|
}
|
|
|
|
s->telnet_init = g_new0(TCPChardevTelnetInit, 1);
|
|
init = s->telnet_init;
|
|
|
|
#define IACSET(x, a, b, c) \
|
|
do { \
|
|
x[n++] = a; \
|
|
x[n++] = b; \
|
|
x[n++] = c; \
|
|
} while (0)
|
|
|
|
if (!s->is_tn3270) {
|
|
init->buflen = 12;
|
|
/* Prep the telnet negotion to put telnet in binary,
|
|
* no echo, single char mode */
|
|
IACSET(init->buf, 0xff, 0xfb, 0x01); /* IAC WILL ECHO */
|
|
IACSET(init->buf, 0xff, 0xfb, 0x03); /* IAC WILL Suppress go ahead */
|
|
IACSET(init->buf, 0xff, 0xfb, 0x00); /* IAC WILL Binary */
|
|
IACSET(init->buf, 0xff, 0xfd, 0x00); /* IAC DO Binary */
|
|
} else {
|
|
init->buflen = 21;
|
|
/* Prep the TN3270 negotion based on RFC1576 */
|
|
IACSET(init->buf, 0xff, 0xfd, 0x19); /* IAC DO EOR */
|
|
IACSET(init->buf, 0xff, 0xfb, 0x19); /* IAC WILL EOR */
|
|
IACSET(init->buf, 0xff, 0xfd, 0x00); /* IAC DO BINARY */
|
|
IACSET(init->buf, 0xff, 0xfb, 0x00); /* IAC WILL BINARY */
|
|
IACSET(init->buf, 0xff, 0xfd, 0x18); /* IAC DO TERMINAL TYPE */
|
|
IACSET(init->buf, 0xff, 0xfa, 0x18); /* IAC SB TERMINAL TYPE */
|
|
IACSET(init->buf, 0x01, 0xff, 0xf0); /* SEND IAC SE */
|
|
}
|
|
|
|
#undef IACSET
|
|
|
|
cont:
|
|
s->telnet_source = qio_channel_add_watch_source(s->ioc, G_IO_OUT,
|
|
tcp_chr_telnet_init_io,
|
|
s, NULL,
|
|
chr->gcontext);
|
|
}
|
|
|
|
|
|
static void tcp_chr_tls_handshake(QIOTask *task,
|
|
gpointer user_data)
|
|
{
|
|
Chardev *chr = user_data;
|
|
SocketChardev *s = user_data;
|
|
|
|
if (qio_task_propagate_error(task, NULL)) {
|
|
tcp_chr_disconnect(chr);
|
|
} else {
|
|
if (s->do_telnetopt) {
|
|
tcp_chr_telnet_init(chr);
|
|
} else {
|
|
tcp_chr_connect(chr);
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
static void tcp_chr_tls_init(Chardev *chr)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
QIOChannelTLS *tioc;
|
|
Error *err = NULL;
|
|
gchar *name;
|
|
|
|
if (!machine_init_done) {
|
|
/* This will be postponed to machine_done notifier */
|
|
return;
|
|
}
|
|
|
|
if (s->is_listen) {
|
|
tioc = qio_channel_tls_new_server(
|
|
s->ioc, s->tls_creds,
|
|
NULL, /* XXX Use an ACL */
|
|
&err);
|
|
} else {
|
|
tioc = qio_channel_tls_new_client(
|
|
s->ioc, s->tls_creds,
|
|
s->addr->u.inet.host,
|
|
&err);
|
|
}
|
|
if (tioc == NULL) {
|
|
error_free(err);
|
|
tcp_chr_disconnect(chr);
|
|
return;
|
|
}
|
|
name = g_strdup_printf("chardev-tls-%s-%s",
|
|
s->is_listen ? "server" : "client",
|
|
chr->label);
|
|
qio_channel_set_name(QIO_CHANNEL(tioc), name);
|
|
g_free(name);
|
|
object_unref(OBJECT(s->ioc));
|
|
s->ioc = QIO_CHANNEL(tioc);
|
|
|
|
qio_channel_tls_handshake(tioc,
|
|
tcp_chr_tls_handshake,
|
|
chr,
|
|
NULL,
|
|
chr->gcontext);
|
|
}
|
|
|
|
|
|
static void tcp_chr_set_client_ioc_name(Chardev *chr,
|
|
QIOChannelSocket *sioc)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
char *name;
|
|
name = g_strdup_printf("chardev-tcp-%s-%s",
|
|
s->is_listen ? "server" : "client",
|
|
chr->label);
|
|
qio_channel_set_name(QIO_CHANNEL(sioc), name);
|
|
g_free(name);
|
|
|
|
}
|
|
|
|
static int tcp_chr_new_client(Chardev *chr, QIOChannelSocket *sioc)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
|
|
if (s->ioc != NULL) {
|
|
return -1;
|
|
}
|
|
|
|
s->ioc = QIO_CHANNEL(sioc);
|
|
object_ref(OBJECT(sioc));
|
|
s->sioc = sioc;
|
|
object_ref(OBJECT(sioc));
|
|
|
|
qio_channel_set_blocking(s->ioc, false, NULL);
|
|
|
|
if (s->do_nodelay) {
|
|
qio_channel_set_delay(s->ioc, false);
|
|
}
|
|
if (s->listener) {
|
|
qio_net_listener_set_client_func_full(s->listener, NULL, NULL,
|
|
NULL, chr->gcontext);
|
|
}
|
|
|
|
if (s->tls_creds) {
|
|
tcp_chr_tls_init(chr);
|
|
} else {
|
|
if (s->do_telnetopt) {
|
|
tcp_chr_telnet_init(chr);
|
|
} else {
|
|
tcp_chr_connect(chr);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int tcp_chr_add_client(Chardev *chr, int fd)
|
|
{
|
|
int ret;
|
|
QIOChannelSocket *sioc;
|
|
|
|
sioc = qio_channel_socket_new_fd(fd, NULL);
|
|
if (!sioc) {
|
|
return -1;
|
|
}
|
|
tcp_chr_set_client_ioc_name(chr, sioc);
|
|
ret = tcp_chr_new_client(chr, sioc);
|
|
object_unref(OBJECT(sioc));
|
|
return ret;
|
|
}
|
|
|
|
static void tcp_chr_accept(QIONetListener *listener,
|
|
QIOChannelSocket *cioc,
|
|
void *opaque)
|
|
{
|
|
Chardev *chr = CHARDEV(opaque);
|
|
|
|
tcp_chr_set_client_ioc_name(chr, cioc);
|
|
tcp_chr_new_client(chr, cioc);
|
|
}
|
|
|
|
static int tcp_chr_wait_connected(Chardev *chr, Error **errp)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
QIOChannelSocket *sioc;
|
|
|
|
/* It can't wait on s->connected, since it is set asynchronously
|
|
* in TLS and telnet cases, only wait for an accepted socket */
|
|
while (!s->ioc) {
|
|
if (s->is_listen) {
|
|
info_report("QEMU waiting for connection on: %s",
|
|
chr->filename);
|
|
sioc = qio_net_listener_wait_client(s->listener);
|
|
tcp_chr_set_client_ioc_name(chr, sioc);
|
|
tcp_chr_new_client(chr, sioc);
|
|
object_unref(OBJECT(sioc));
|
|
} else {
|
|
sioc = qio_channel_socket_new();
|
|
tcp_chr_set_client_ioc_name(chr, sioc);
|
|
if (qio_channel_socket_connect_sync(sioc, s->addr, errp) < 0) {
|
|
object_unref(OBJECT(sioc));
|
|
return -1;
|
|
}
|
|
tcp_chr_new_client(chr, sioc);
|
|
object_unref(OBJECT(sioc));
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void char_socket_finalize(Object *obj)
|
|
{
|
|
Chardev *chr = CHARDEV(obj);
|
|
SocketChardev *s = SOCKET_CHARDEV(obj);
|
|
|
|
tcp_chr_free_connection(chr);
|
|
tcp_chr_reconn_timer_cancel(s);
|
|
qapi_free_SocketAddress(s->addr);
|
|
tcp_chr_telnet_destroy(s);
|
|
g_free(s->telnet_init);
|
|
if (s->listener) {
|
|
qio_net_listener_set_client_func_full(s->listener, NULL, NULL,
|
|
NULL, chr->gcontext);
|
|
object_unref(OBJECT(s->listener));
|
|
}
|
|
if (s->tls_creds) {
|
|
object_unref(OBJECT(s->tls_creds));
|
|
}
|
|
|
|
qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
|
|
}
|
|
|
|
static void qemu_chr_socket_connected(QIOTask *task, void *opaque)
|
|
{
|
|
QIOChannelSocket *sioc = QIO_CHANNEL_SOCKET(qio_task_get_source(task));
|
|
Chardev *chr = CHARDEV(opaque);
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
Error *err = NULL;
|
|
|
|
if (qio_task_propagate_error(task, &err)) {
|
|
check_report_connect_error(chr, err);
|
|
error_free(err);
|
|
goto cleanup;
|
|
}
|
|
|
|
s->connect_err_reported = false;
|
|
tcp_chr_new_client(chr, sioc);
|
|
|
|
cleanup:
|
|
object_unref(OBJECT(sioc));
|
|
}
|
|
|
|
static void tcp_chr_connect_async(Chardev *chr)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
QIOChannelSocket *sioc;
|
|
|
|
sioc = qio_channel_socket_new();
|
|
tcp_chr_set_client_ioc_name(chr, sioc);
|
|
qio_channel_socket_connect_async(sioc, s->addr,
|
|
qemu_chr_socket_connected,
|
|
chr, NULL, chr->gcontext);
|
|
}
|
|
|
|
static gboolean socket_reconnect_timeout(gpointer opaque)
|
|
{
|
|
Chardev *chr = CHARDEV(opaque);
|
|
SocketChardev *s = SOCKET_CHARDEV(opaque);
|
|
|
|
g_source_unref(s->reconnect_timer);
|
|
s->reconnect_timer = NULL;
|
|
|
|
if (chr->be_open) {
|
|
return false;
|
|
}
|
|
|
|
tcp_chr_connect_async(chr);
|
|
|
|
return false;
|
|
}
|
|
|
|
static void qmp_chardev_open_socket(Chardev *chr,
|
|
ChardevBackend *backend,
|
|
bool *be_opened,
|
|
Error **errp)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
ChardevSocket *sock = backend->u.socket.data;
|
|
bool do_nodelay = sock->has_nodelay ? sock->nodelay : false;
|
|
bool is_listen = sock->has_server ? sock->server : true;
|
|
bool is_telnet = sock->has_telnet ? sock->telnet : false;
|
|
bool is_tn3270 = sock->has_tn3270 ? sock->tn3270 : false;
|
|
bool is_waitconnect = sock->has_wait ? sock->wait : false;
|
|
int64_t reconnect = sock->has_reconnect ? sock->reconnect : 0;
|
|
QIOChannelSocket *sioc = NULL;
|
|
SocketAddress *addr;
|
|
|
|
s->is_listen = is_listen;
|
|
s->is_telnet = is_telnet;
|
|
s->is_tn3270 = is_tn3270;
|
|
s->do_nodelay = do_nodelay;
|
|
if (sock->tls_creds) {
|
|
Object *creds;
|
|
creds = object_resolve_path_component(
|
|
object_get_objects_root(), sock->tls_creds);
|
|
if (!creds) {
|
|
error_setg(errp, "No TLS credentials with id '%s'",
|
|
sock->tls_creds);
|
|
goto error;
|
|
}
|
|
s->tls_creds = (QCryptoTLSCreds *)
|
|
object_dynamic_cast(creds,
|
|
TYPE_QCRYPTO_TLS_CREDS);
|
|
if (!s->tls_creds) {
|
|
error_setg(errp, "Object with id '%s' is not TLS credentials",
|
|
sock->tls_creds);
|
|
goto error;
|
|
}
|
|
object_ref(OBJECT(s->tls_creds));
|
|
if (is_listen) {
|
|
if (s->tls_creds->endpoint != QCRYPTO_TLS_CREDS_ENDPOINT_SERVER) {
|
|
error_setg(errp, "%s",
|
|
"Expected TLS credentials for server endpoint");
|
|
goto error;
|
|
}
|
|
} else {
|
|
if (s->tls_creds->endpoint != QCRYPTO_TLS_CREDS_ENDPOINT_CLIENT) {
|
|
error_setg(errp, "%s",
|
|
"Expected TLS credentials for client endpoint");
|
|
goto error;
|
|
}
|
|
}
|
|
}
|
|
|
|
s->addr = addr = socket_address_flatten(sock->addr);
|
|
|
|
qemu_chr_set_feature(chr, QEMU_CHAR_FEATURE_RECONNECTABLE);
|
|
/* TODO SOCKET_ADDRESS_FD where fd has AF_UNIX */
|
|
if (addr->type == SOCKET_ADDRESS_TYPE_UNIX) {
|
|
qemu_chr_set_feature(chr, QEMU_CHAR_FEATURE_FD_PASS);
|
|
}
|
|
|
|
/* be isn't opened until we get a connection */
|
|
*be_opened = false;
|
|
|
|
update_disconnected_filename(s);
|
|
|
|
if (is_listen) {
|
|
if (is_telnet || is_tn3270) {
|
|
s->do_telnetopt = 1;
|
|
}
|
|
} else if (reconnect > 0) {
|
|
s->reconnect_time = reconnect;
|
|
}
|
|
|
|
/* If reconnect_time is set, will do that in chr_machine_done. */
|
|
if (!s->reconnect_time) {
|
|
if (s->is_listen) {
|
|
char *name;
|
|
s->listener = qio_net_listener_new();
|
|
|
|
name = g_strdup_printf("chardev-tcp-listener-%s", chr->label);
|
|
qio_net_listener_set_name(s->listener, name);
|
|
g_free(name);
|
|
|
|
if (qio_net_listener_open_sync(s->listener, s->addr, errp) < 0) {
|
|
object_unref(OBJECT(s->listener));
|
|
s->listener = NULL;
|
|
goto error;
|
|
}
|
|
|
|
qapi_free_SocketAddress(s->addr);
|
|
s->addr = socket_local_address(s->listener->sioc[0]->fd, errp);
|
|
update_disconnected_filename(s);
|
|
|
|
if (is_waitconnect &&
|
|
qemu_chr_wait_connected(chr, errp) < 0) {
|
|
return;
|
|
}
|
|
if (!s->ioc) {
|
|
qio_net_listener_set_client_func_full(s->listener,
|
|
tcp_chr_accept,
|
|
chr, NULL,
|
|
chr->gcontext);
|
|
}
|
|
} else if (qemu_chr_wait_connected(chr, errp) < 0) {
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
return;
|
|
|
|
error:
|
|
if (sioc) {
|
|
object_unref(OBJECT(sioc));
|
|
}
|
|
}
|
|
|
|
static void qemu_chr_parse_socket(QemuOpts *opts, ChardevBackend *backend,
|
|
Error **errp)
|
|
{
|
|
bool is_listen = qemu_opt_get_bool(opts, "server", false);
|
|
bool is_waitconnect = is_listen && qemu_opt_get_bool(opts, "wait", true);
|
|
bool is_telnet = qemu_opt_get_bool(opts, "telnet", false);
|
|
bool is_tn3270 = qemu_opt_get_bool(opts, "tn3270", false);
|
|
bool do_nodelay = !qemu_opt_get_bool(opts, "delay", true);
|
|
int64_t reconnect = qemu_opt_get_number(opts, "reconnect", 0);
|
|
const char *path = qemu_opt_get(opts, "path");
|
|
const char *host = qemu_opt_get(opts, "host");
|
|
const char *port = qemu_opt_get(opts, "port");
|
|
const char *fd = qemu_opt_get(opts, "fd");
|
|
const char *tls_creds = qemu_opt_get(opts, "tls-creds");
|
|
SocketAddressLegacy *addr;
|
|
ChardevSocket *sock;
|
|
|
|
if ((!!path + !!fd + !!host) != 1) {
|
|
error_setg(errp,
|
|
"Exactly one of 'path', 'fd' or 'host' required");
|
|
return;
|
|
}
|
|
|
|
backend->type = CHARDEV_BACKEND_KIND_SOCKET;
|
|
if (path) {
|
|
if (tls_creds) {
|
|
error_setg(errp, "TLS can only be used over TCP socket");
|
|
return;
|
|
}
|
|
} else if (host) {
|
|
if (!port) {
|
|
error_setg(errp, "chardev: socket: no port given");
|
|
return;
|
|
}
|
|
} else if (fd) {
|
|
/* We don't know what host to validate against when in client mode */
|
|
if (tls_creds && !is_listen) {
|
|
error_setg(errp, "TLS can not be used with pre-opened client FD");
|
|
return;
|
|
}
|
|
} else {
|
|
g_assert_not_reached();
|
|
}
|
|
|
|
sock = backend->u.socket.data = g_new0(ChardevSocket, 1);
|
|
qemu_chr_parse_common(opts, qapi_ChardevSocket_base(sock));
|
|
|
|
sock->has_nodelay = true;
|
|
sock->nodelay = do_nodelay;
|
|
sock->has_server = true;
|
|
sock->server = is_listen;
|
|
sock->has_telnet = true;
|
|
sock->telnet = is_telnet;
|
|
sock->has_tn3270 = true;
|
|
sock->tn3270 = is_tn3270;
|
|
sock->has_wait = true;
|
|
sock->wait = is_waitconnect;
|
|
sock->has_reconnect = true;
|
|
sock->reconnect = reconnect;
|
|
sock->tls_creds = g_strdup(tls_creds);
|
|
|
|
addr = g_new0(SocketAddressLegacy, 1);
|
|
if (path) {
|
|
UnixSocketAddress *q_unix;
|
|
addr->type = SOCKET_ADDRESS_LEGACY_KIND_UNIX;
|
|
q_unix = addr->u.q_unix.data = g_new0(UnixSocketAddress, 1);
|
|
q_unix->path = g_strdup(path);
|
|
} else if (host) {
|
|
addr->type = SOCKET_ADDRESS_LEGACY_KIND_INET;
|
|
addr->u.inet.data = g_new(InetSocketAddress, 1);
|
|
*addr->u.inet.data = (InetSocketAddress) {
|
|
.host = g_strdup(host),
|
|
.port = g_strdup(port),
|
|
.has_to = qemu_opt_get(opts, "to"),
|
|
.to = qemu_opt_get_number(opts, "to", 0),
|
|
.has_ipv4 = qemu_opt_get(opts, "ipv4"),
|
|
.ipv4 = qemu_opt_get_bool(opts, "ipv4", 0),
|
|
.has_ipv6 = qemu_opt_get(opts, "ipv6"),
|
|
.ipv6 = qemu_opt_get_bool(opts, "ipv6", 0),
|
|
};
|
|
} else if (fd) {
|
|
addr->type = SOCKET_ADDRESS_LEGACY_KIND_FD;
|
|
addr->u.fd.data = g_new(String, 1);
|
|
addr->u.fd.data->str = g_strdup(fd);
|
|
} else {
|
|
g_assert_not_reached();
|
|
}
|
|
sock->addr = addr;
|
|
}
|
|
|
|
static void
|
|
char_socket_get_addr(Object *obj, Visitor *v, const char *name,
|
|
void *opaque, Error **errp)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(obj);
|
|
|
|
visit_type_SocketAddress(v, name, &s->addr, errp);
|
|
}
|
|
|
|
static bool
|
|
char_socket_get_connected(Object *obj, Error **errp)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(obj);
|
|
|
|
return s->connected;
|
|
}
|
|
|
|
static int tcp_chr_machine_done_hook(Chardev *chr)
|
|
{
|
|
SocketChardev *s = SOCKET_CHARDEV(chr);
|
|
|
|
if (s->reconnect_time) {
|
|
tcp_chr_connect_async(chr);
|
|
}
|
|
|
|
if (s->ioc && s->tls_creds) {
|
|
tcp_chr_tls_init(chr);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void char_socket_class_init(ObjectClass *oc, void *data)
|
|
{
|
|
ChardevClass *cc = CHARDEV_CLASS(oc);
|
|
|
|
cc->parse = qemu_chr_parse_socket;
|
|
cc->open = qmp_chardev_open_socket;
|
|
cc->chr_wait_connected = tcp_chr_wait_connected;
|
|
cc->chr_write = tcp_chr_write;
|
|
cc->chr_sync_read = tcp_chr_sync_read;
|
|
cc->chr_disconnect = tcp_chr_disconnect;
|
|
cc->get_msgfds = tcp_get_msgfds;
|
|
cc->set_msgfds = tcp_set_msgfds;
|
|
cc->chr_add_client = tcp_chr_add_client;
|
|
cc->chr_add_watch = tcp_chr_add_watch;
|
|
cc->chr_update_read_handler = tcp_chr_update_read_handler;
|
|
cc->chr_machine_done = tcp_chr_machine_done_hook;
|
|
|
|
object_class_property_add(oc, "addr", "SocketAddress",
|
|
char_socket_get_addr, NULL,
|
|
NULL, NULL, &error_abort);
|
|
|
|
object_class_property_add_bool(oc, "connected", char_socket_get_connected,
|
|
NULL, &error_abort);
|
|
}
|
|
|
|
static const TypeInfo char_socket_type_info = {
|
|
.name = TYPE_CHARDEV_SOCKET,
|
|
.parent = TYPE_CHARDEV,
|
|
.instance_size = sizeof(SocketChardev),
|
|
.instance_finalize = char_socket_finalize,
|
|
.class_init = char_socket_class_init,
|
|
};
|
|
|
|
static void register_types(void)
|
|
{
|
|
type_register_static(&char_socket_type_info);
|
|
}
|
|
|
|
type_init(register_types);
|