| /* |
| * inet and unix socket functions for qemu |
| * |
| * (c) 2008 Gerd Hoffmann <kraxel@redhat.com> |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; under version 2 of the License. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * Contributions after 2012-01-13 are licensed under the terms of the |
| * GNU GPL, version 2 or (at your option) any later version. |
| */ |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <ctype.h> |
| #include <errno.h> |
| #include <unistd.h> |
| |
| #include "monitor/monitor.h" |
| #include "qemu_socket.h" |
| #include "qemu-common.h" /* for qemu_isdigit */ |
| #include "main-loop.h" |
| |
| #ifndef AI_ADDRCONFIG |
| # define AI_ADDRCONFIG 0 |
| #endif |
| |
| static const int on=1, off=0; |
| |
| /* used temporarely until all users are converted to QemuOpts */ |
| static QemuOptsList dummy_opts = { |
| .name = "dummy", |
| .head = QTAILQ_HEAD_INITIALIZER(dummy_opts.head), |
| .desc = { |
| { |
| .name = "path", |
| .type = QEMU_OPT_STRING, |
| },{ |
| .name = "host", |
| .type = QEMU_OPT_STRING, |
| },{ |
| .name = "port", |
| .type = QEMU_OPT_STRING, |
| },{ |
| .name = "to", |
| .type = QEMU_OPT_NUMBER, |
| },{ |
| .name = "ipv4", |
| .type = QEMU_OPT_BOOL, |
| },{ |
| .name = "ipv6", |
| .type = QEMU_OPT_BOOL, |
| }, |
| { /* end if list */ } |
| }, |
| }; |
| |
| static int inet_getport(struct addrinfo *e) |
| { |
| struct sockaddr_in *i4; |
| struct sockaddr_in6 *i6; |
| |
| switch (e->ai_family) { |
| case PF_INET6: |
| i6 = (void*)e->ai_addr; |
| return ntohs(i6->sin6_port); |
| case PF_INET: |
| i4 = (void*)e->ai_addr; |
| return ntohs(i4->sin_port); |
| default: |
| return 0; |
| } |
| } |
| |
| static void inet_setport(struct addrinfo *e, int port) |
| { |
| struct sockaddr_in *i4; |
| struct sockaddr_in6 *i6; |
| |
| switch (e->ai_family) { |
| case PF_INET6: |
| i6 = (void*)e->ai_addr; |
| i6->sin6_port = htons(port); |
| break; |
| case PF_INET: |
| i4 = (void*)e->ai_addr; |
| i4->sin_port = htons(port); |
| break; |
| } |
| } |
| |
| const char *inet_strfamily(int family) |
| { |
| switch (family) { |
| case PF_INET6: return "ipv6"; |
| case PF_INET: return "ipv4"; |
| case PF_UNIX: return "unix"; |
| } |
| return "unknown"; |
| } |
| |
| int inet_listen_opts(QemuOpts *opts, int port_offset, Error **errp) |
| { |
| struct addrinfo ai,*res,*e; |
| const char *addr; |
| char port[33]; |
| char uaddr[INET6_ADDRSTRLEN+1]; |
| char uport[33]; |
| int slisten, rc, to, port_min, port_max, p; |
| |
| memset(&ai,0, sizeof(ai)); |
| ai.ai_flags = AI_PASSIVE | AI_ADDRCONFIG; |
| ai.ai_family = PF_UNSPEC; |
| ai.ai_socktype = SOCK_STREAM; |
| |
| if ((qemu_opt_get(opts, "host") == NULL) || |
| (qemu_opt_get(opts, "port") == NULL)) { |
| error_setg(errp, "host and/or port not specified"); |
| return -1; |
| } |
| pstrcpy(port, sizeof(port), qemu_opt_get(opts, "port")); |
| addr = qemu_opt_get(opts, "host"); |
| |
| to = qemu_opt_get_number(opts, "to", 0); |
| if (qemu_opt_get_bool(opts, "ipv4", 0)) |
| ai.ai_family = PF_INET; |
| if (qemu_opt_get_bool(opts, "ipv6", 0)) |
| ai.ai_family = PF_INET6; |
| |
| /* lookup */ |
| if (port_offset) |
| snprintf(port, sizeof(port), "%d", atoi(port) + port_offset); |
| rc = getaddrinfo(strlen(addr) ? addr : NULL, port, &ai, &res); |
| if (rc != 0) { |
| error_setg(errp, "address resolution failed for %s:%s: %s", addr, port, |
| gai_strerror(rc)); |
| return -1; |
| } |
| |
| /* create socket + bind */ |
| for (e = res; e != NULL; e = e->ai_next) { |
| getnameinfo((struct sockaddr*)e->ai_addr,e->ai_addrlen, |
| uaddr,INET6_ADDRSTRLEN,uport,32, |
| NI_NUMERICHOST | NI_NUMERICSERV); |
| slisten = qemu_socket(e->ai_family, e->ai_socktype, e->ai_protocol); |
| if (slisten < 0) { |
| if (!e->ai_next) { |
| error_set_errno(errp, errno, QERR_SOCKET_CREATE_FAILED); |
| } |
| continue; |
| } |
| |
| setsockopt(slisten,SOL_SOCKET,SO_REUSEADDR,(void*)&on,sizeof(on)); |
| #ifdef IPV6_V6ONLY |
| if (e->ai_family == PF_INET6) { |
| /* listen on both ipv4 and ipv6 */ |
| setsockopt(slisten,IPPROTO_IPV6,IPV6_V6ONLY,(void*)&off, |
| sizeof(off)); |
| } |
| #endif |
| |
| port_min = inet_getport(e); |
| port_max = to ? to + port_offset : port_min; |
| for (p = port_min; p <= port_max; p++) { |
| inet_setport(e, p); |
| if (bind(slisten, e->ai_addr, e->ai_addrlen) == 0) { |
| goto listen; |
| } |
| if (p == port_max) { |
| if (!e->ai_next) { |
| error_set_errno(errp, errno, QERR_SOCKET_BIND_FAILED); |
| } |
| } |
| } |
| closesocket(slisten); |
| } |
| freeaddrinfo(res); |
| return -1; |
| |
| listen: |
| if (listen(slisten,1) != 0) { |
| error_set_errno(errp, errno, QERR_SOCKET_LISTEN_FAILED); |
| closesocket(slisten); |
| freeaddrinfo(res); |
| return -1; |
| } |
| snprintf(uport, sizeof(uport), "%d", inet_getport(e) - port_offset); |
| qemu_opt_set(opts, "host", uaddr); |
| qemu_opt_set(opts, "port", uport); |
| qemu_opt_set(opts, "ipv6", (e->ai_family == PF_INET6) ? "on" : "off"); |
| qemu_opt_set(opts, "ipv4", (e->ai_family != PF_INET6) ? "on" : "off"); |
| freeaddrinfo(res); |
| return slisten; |
| } |
| |
| #ifdef _WIN32 |
| #define QEMU_SOCKET_RC_INPROGRESS(rc) \ |
| ((rc) == -EINPROGRESS || (rc) == -EWOULDBLOCK || (rc) == -WSAEALREADY) |
| #else |
| #define QEMU_SOCKET_RC_INPROGRESS(rc) \ |
| ((rc) == -EINPROGRESS) |
| #endif |
| |
| /* Struct to store connect state for non blocking connect */ |
| typedef struct ConnectState { |
| int fd; |
| struct addrinfo *addr_list; |
| struct addrinfo *current_addr; |
| NonBlockingConnectHandler *callback; |
| void *opaque; |
| } ConnectState; |
| |
| static int inet_connect_addr(struct addrinfo *addr, bool *in_progress, |
| ConnectState *connect_state, Error **errp); |
| |
| static void wait_for_connect(void *opaque) |
| { |
| ConnectState *s = opaque; |
| int val = 0, rc = 0; |
| socklen_t valsize = sizeof(val); |
| bool in_progress; |
| |
| qemu_set_fd_handler2(s->fd, NULL, NULL, NULL, NULL); |
| |
| do { |
| rc = getsockopt(s->fd, SOL_SOCKET, SO_ERROR, (void *) &val, &valsize); |
| } while (rc == -1 && socket_error() == EINTR); |
| |
| /* update rc to contain error */ |
| if (!rc && val) { |
| rc = -1; |
| } |
| |
| /* connect error */ |
| if (rc < 0) { |
| closesocket(s->fd); |
| s->fd = rc; |
| } |
| |
| /* try to connect to the next address on the list */ |
| if (s->current_addr) { |
| while (s->current_addr->ai_next != NULL && s->fd < 0) { |
| s->current_addr = s->current_addr->ai_next; |
| s->fd = inet_connect_addr(s->current_addr, &in_progress, s, NULL); |
| /* connect in progress */ |
| if (in_progress) { |
| return; |
| } |
| } |
| |
| freeaddrinfo(s->addr_list); |
| } |
| |
| if (s->callback) { |
| s->callback(s->fd, s->opaque); |
| } |
| g_free(s); |
| } |
| |
| static int inet_connect_addr(struct addrinfo *addr, bool *in_progress, |
| ConnectState *connect_state, Error **errp) |
| { |
| int sock, rc; |
| |
| *in_progress = false; |
| |
| sock = qemu_socket(addr->ai_family, addr->ai_socktype, addr->ai_protocol); |
| if (sock < 0) { |
| error_set_errno(errp, errno, QERR_SOCKET_CREATE_FAILED); |
| return -1; |
| } |
| qemu_setsockopt(sock, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on)); |
| if (connect_state != NULL) { |
| socket_set_nonblock(sock); |
| } |
| /* connect to peer */ |
| do { |
| rc = 0; |
| if (connect(sock, addr->ai_addr, addr->ai_addrlen) < 0) { |
| rc = -socket_error(); |
| } |
| } while (rc == -EINTR); |
| |
| if (connect_state != NULL && QEMU_SOCKET_RC_INPROGRESS(rc)) { |
| connect_state->fd = sock; |
| qemu_set_fd_handler2(sock, NULL, NULL, wait_for_connect, |
| connect_state); |
| *in_progress = true; |
| } else if (rc < 0) { |
| error_set_errno(errp, errno, QERR_SOCKET_CONNECT_FAILED); |
| closesocket(sock); |
| return -1; |
| } |
| return sock; |
| } |
| |
| static struct addrinfo *inet_parse_connect_opts(QemuOpts *opts, Error **errp) |
| { |
| struct addrinfo ai, *res; |
| int rc; |
| const char *addr; |
| const char *port; |
| |
| memset(&ai, 0, sizeof(ai)); |
| |
| ai.ai_flags = AI_CANONNAME | AI_ADDRCONFIG; |
| ai.ai_family = PF_UNSPEC; |
| ai.ai_socktype = SOCK_STREAM; |
| |
| addr = qemu_opt_get(opts, "host"); |
| port = qemu_opt_get(opts, "port"); |
| if (addr == NULL || port == NULL) { |
| error_setg(errp, "host and/or port not specified"); |
| return NULL; |
| } |
| |
| if (qemu_opt_get_bool(opts, "ipv4", 0)) { |
| ai.ai_family = PF_INET; |
| } |
| if (qemu_opt_get_bool(opts, "ipv6", 0)) { |
| ai.ai_family = PF_INET6; |
| } |
| |
| /* lookup */ |
| rc = getaddrinfo(addr, port, &ai, &res); |
| if (rc != 0) { |
| error_setg(errp, "address resolution failed for %s:%s: %s", addr, port, |
| gai_strerror(rc)); |
| return NULL; |
| } |
| return res; |
| } |
| |
| /** |
| * Create a socket and connect it to an address. |
| * |
| * @opts: QEMU options, recognized parameters strings "host" and "port", |
| * bools "ipv4" and "ipv6". |
| * @errp: set on error |
| * @callback: callback function for non-blocking connect |
| * @opaque: opaque for callback function |
| * |
| * Returns: -1 on error, file descriptor on success. |
| * |
| * If @callback is non-null, the connect is non-blocking. If this |
| * function succeeds, callback will be called when the connection |
| * completes, with the file descriptor on success, or -1 on error. |
| */ |
| int inet_connect_opts(QemuOpts *opts, Error **errp, |
| NonBlockingConnectHandler *callback, void *opaque) |
| { |
| struct addrinfo *res, *e; |
| int sock = -1; |
| bool in_progress; |
| ConnectState *connect_state = NULL; |
| |
| res = inet_parse_connect_opts(opts, errp); |
| if (!res) { |
| return -1; |
| } |
| |
| if (callback != NULL) { |
| connect_state = g_malloc0(sizeof(*connect_state)); |
| connect_state->addr_list = res; |
| connect_state->callback = callback; |
| connect_state->opaque = opaque; |
| } |
| |
| for (e = res; e != NULL; e = e->ai_next) { |
| if (connect_state != NULL) { |
| connect_state->current_addr = e; |
| } |
| sock = inet_connect_addr(e, &in_progress, connect_state, errp); |
| if (in_progress) { |
| return sock; |
| } else if (sock >= 0) { |
| /* non blocking socket immediate success, call callback */ |
| if (callback != NULL) { |
| callback(sock, opaque); |
| } |
| break; |
| } |
| } |
| g_free(connect_state); |
| freeaddrinfo(res); |
| return sock; |
| } |
| |
| int inet_dgram_opts(QemuOpts *opts, Error **errp) |
| { |
| struct addrinfo ai, *peer = NULL, *local = NULL; |
| const char *addr; |
| const char *port; |
| int sock = -1, rc; |
| |
| /* lookup peer addr */ |
| memset(&ai,0, sizeof(ai)); |
| ai.ai_flags = AI_CANONNAME | AI_ADDRCONFIG; |
| ai.ai_family = PF_UNSPEC; |
| ai.ai_socktype = SOCK_DGRAM; |
| |
| addr = qemu_opt_get(opts, "host"); |
| port = qemu_opt_get(opts, "port"); |
| if (addr == NULL || strlen(addr) == 0) { |
| addr = "localhost"; |
| } |
| if (port == NULL || strlen(port) == 0) { |
| error_setg(errp, "remote port not specified"); |
| return -1; |
| } |
| |
| if (qemu_opt_get_bool(opts, "ipv4", 0)) |
| ai.ai_family = PF_INET; |
| if (qemu_opt_get_bool(opts, "ipv6", 0)) |
| ai.ai_family = PF_INET6; |
| |
| if (0 != (rc = getaddrinfo(addr, port, &ai, &peer))) { |
| error_setg(errp, "address resolution failed for %s:%s: %s", addr, port, |
| gai_strerror(rc)); |
| return -1; |
| } |
| |
| /* lookup local addr */ |
| memset(&ai,0, sizeof(ai)); |
| ai.ai_flags = AI_PASSIVE; |
| ai.ai_family = peer->ai_family; |
| ai.ai_socktype = SOCK_DGRAM; |
| |
| addr = qemu_opt_get(opts, "localaddr"); |
| port = qemu_opt_get(opts, "localport"); |
| if (addr == NULL || strlen(addr) == 0) { |
| addr = NULL; |
| } |
| if (!port || strlen(port) == 0) |
| port = "0"; |
| |
| if (0 != (rc = getaddrinfo(addr, port, &ai, &local))) { |
| error_setg(errp, "address resolution failed for %s:%s: %s", addr, port, |
| gai_strerror(rc)); |
| goto err; |
| } |
| |
| /* create socket */ |
| sock = qemu_socket(peer->ai_family, peer->ai_socktype, peer->ai_protocol); |
| if (sock < 0) { |
| error_set_errno(errp, errno, QERR_SOCKET_CREATE_FAILED); |
| goto err; |
| } |
| setsockopt(sock,SOL_SOCKET,SO_REUSEADDR,(void*)&on,sizeof(on)); |
| |
| /* bind socket */ |
| if (bind(sock, local->ai_addr, local->ai_addrlen) < 0) { |
| error_set_errno(errp, errno, QERR_SOCKET_BIND_FAILED); |
| goto err; |
| } |
| |
| /* connect to peer */ |
| if (connect(sock,peer->ai_addr,peer->ai_addrlen) < 0) { |
| error_set_errno(errp, errno, QERR_SOCKET_CONNECT_FAILED); |
| goto err; |
| } |
| |
| freeaddrinfo(local); |
| freeaddrinfo(peer); |
| return sock; |
| |
| err: |
| if (-1 != sock) |
| closesocket(sock); |
| if (local) |
| freeaddrinfo(local); |
| if (peer) |
| freeaddrinfo(peer); |
| return -1; |
| } |
| |
| /* compatibility wrapper */ |
| static InetSocketAddress *inet_parse(const char *str, Error **errp) |
| { |
| InetSocketAddress *addr; |
| const char *optstr, *h; |
| char host[64]; |
| char port[33]; |
| int to; |
| int pos; |
| |
| addr = g_new0(InetSocketAddress, 1); |
| |
| /* parse address */ |
| if (str[0] == ':') { |
| /* no host given */ |
| host[0] = '\0'; |
| if (1 != sscanf(str, ":%32[^,]%n", port, &pos)) { |
| error_setg(errp, "error parsing port in address '%s'", str); |
| goto fail; |
| } |
| } else if (str[0] == '[') { |
| /* IPv6 addr */ |
| if (2 != sscanf(str, "[%64[^]]]:%32[^,]%n", host, port, &pos)) { |
| error_setg(errp, "error parsing IPv6 address '%s'", str); |
| goto fail; |
| } |
| addr->ipv6 = addr->has_ipv6 = true; |
| } else if (qemu_isdigit(str[0])) { |
| /* IPv4 addr */ |
| if (2 != sscanf(str, "%64[0-9.]:%32[^,]%n", host, port, &pos)) { |
| error_setg(errp, "error parsing IPv4 address '%s'", str); |
| goto fail; |
| } |
| addr->ipv4 = addr->has_ipv4 = true; |
| } else { |
| /* hostname */ |
| if (2 != sscanf(str, "%64[^:]:%32[^,]%n", host, port, &pos)) { |
| error_setg(errp, "error parsing address '%s'", str); |
| goto fail; |
| } |
| } |
| |
| addr->host = g_strdup(host); |
| addr->port = g_strdup(port); |
| |
| /* parse options */ |
| optstr = str + pos; |
| h = strstr(optstr, ",to="); |
| if (h) { |
| h += 4; |
| if (sscanf(h, "%d%n", &to, &pos) != 1 || |
| (h[pos] != '\0' && h[pos] != ',')) { |
| error_setg(errp, "error parsing to= argument"); |
| goto fail; |
| } |
| addr->has_to = true; |
| addr->to = to; |
| } |
| if (strstr(optstr, ",ipv4")) { |
| addr->ipv4 = addr->has_ipv4 = true; |
| } |
| if (strstr(optstr, ",ipv6")) { |
| addr->ipv6 = addr->has_ipv6 = true; |
| } |
| return addr; |
| |
| fail: |
| qapi_free_InetSocketAddress(addr); |
| return NULL; |
| } |
| |
| static void inet_addr_to_opts(QemuOpts *opts, InetSocketAddress *addr) |
| { |
| bool ipv4 = addr->ipv4 || !addr->has_ipv4; |
| bool ipv6 = addr->ipv6 || !addr->has_ipv6; |
| |
| if (!ipv4 || !ipv6) { |
| qemu_opt_set_bool(opts, "ipv4", ipv4); |
| qemu_opt_set_bool(opts, "ipv6", ipv6); |
| } |
| if (addr->has_to) { |
| char to[20]; |
| snprintf(to, sizeof(to), "%d", addr->to); |
| qemu_opt_set(opts, "to", to); |
| } |
| qemu_opt_set(opts, "host", addr->host); |
| qemu_opt_set(opts, "port", addr->port); |
| } |
| |
| int inet_listen(const char *str, char *ostr, int olen, |
| int socktype, int port_offset, Error **errp) |
| { |
| QemuOpts *opts; |
| char *optstr; |
| int sock = -1; |
| InetSocketAddress *addr; |
| |
| addr = inet_parse(str, errp); |
| if (addr != NULL) { |
| opts = qemu_opts_create_nofail(&dummy_opts); |
| inet_addr_to_opts(opts, addr); |
| qapi_free_InetSocketAddress(addr); |
| sock = inet_listen_opts(opts, port_offset, errp); |
| if (sock != -1 && ostr) { |
| optstr = strchr(str, ','); |
| if (qemu_opt_get_bool(opts, "ipv6", 0)) { |
| snprintf(ostr, olen, "[%s]:%s%s", |
| qemu_opt_get(opts, "host"), |
| qemu_opt_get(opts, "port"), |
| optstr ? optstr : ""); |
| } else { |
| snprintf(ostr, olen, "%s:%s%s", |
| qemu_opt_get(opts, "host"), |
| qemu_opt_get(opts, "port"), |
| optstr ? optstr : ""); |
| } |
| } |
| qemu_opts_del(opts); |
| } |
| return sock; |
| } |
| |
| /** |
| * Create a blocking socket and connect it to an address. |
| * |
| * @str: address string |
| * @errp: set in case of an error |
| * |
| * Returns -1 in case of error, file descriptor on success |
| **/ |
| int inet_connect(const char *str, Error **errp) |
| { |
| QemuOpts *opts; |
| int sock = -1; |
| InetSocketAddress *addr; |
| |
| addr = inet_parse(str, errp); |
| if (addr != NULL) { |
| opts = qemu_opts_create_nofail(&dummy_opts); |
| inet_addr_to_opts(opts, addr); |
| qapi_free_InetSocketAddress(addr); |
| sock = inet_connect_opts(opts, errp, NULL, NULL); |
| qemu_opts_del(opts); |
| } |
| return sock; |
| } |
| |
| /** |
| * Create a non-blocking socket and connect it to an address. |
| * Calls the callback function with fd in case of success or -1 in case of |
| * error. |
| * |
| * @str: address string |
| * @callback: callback function that is called when connect completes, |
| * cannot be NULL. |
| * @opaque: opaque for callback function |
| * @errp: set in case of an error |
| * |
| * Returns: -1 on immediate error, file descriptor on success. |
| **/ |
| int inet_nonblocking_connect(const char *str, |
| NonBlockingConnectHandler *callback, |
| void *opaque, Error **errp) |
| { |
| QemuOpts *opts; |
| int sock = -1; |
| InetSocketAddress *addr; |
| |
| g_assert(callback != NULL); |
| |
| addr = inet_parse(str, errp); |
| if (addr != NULL) { |
| opts = qemu_opts_create_nofail(&dummy_opts); |
| inet_addr_to_opts(opts, addr); |
| qapi_free_InetSocketAddress(addr); |
| sock = inet_connect_opts(opts, errp, callback, opaque); |
| qemu_opts_del(opts); |
| } |
| return sock; |
| } |
| |
| #ifndef _WIN32 |
| |
| int unix_listen_opts(QemuOpts *opts, Error **errp) |
| { |
| struct sockaddr_un un; |
| const char *path = qemu_opt_get(opts, "path"); |
| int sock, fd; |
| |
| sock = qemu_socket(PF_UNIX, SOCK_STREAM, 0); |
| if (sock < 0) { |
| error_set_errno(errp, errno, QERR_SOCKET_CREATE_FAILED); |
| return -1; |
| } |
| |
| memset(&un, 0, sizeof(un)); |
| un.sun_family = AF_UNIX; |
| if (path && strlen(path)) { |
| snprintf(un.sun_path, sizeof(un.sun_path), "%s", path); |
| } else { |
| char *tmpdir = getenv("TMPDIR"); |
| snprintf(un.sun_path, sizeof(un.sun_path), "%s/qemu-socket-XXXXXX", |
| tmpdir ? tmpdir : "/tmp"); |
| /* |
| * This dummy fd usage silences the mktemp() unsecure warning. |
| * Using mkstemp() doesn't make things more secure here |
| * though. bind() complains about existing files, so we have |
| * to unlink first and thus re-open the race window. The |
| * worst case possible is bind() failing, i.e. a DoS attack. |
| */ |
| fd = mkstemp(un.sun_path); close(fd); |
| qemu_opt_set(opts, "path", un.sun_path); |
| } |
| |
| unlink(un.sun_path); |
| if (bind(sock, (struct sockaddr*) &un, sizeof(un)) < 0) { |
| error_set_errno(errp, errno, QERR_SOCKET_BIND_FAILED); |
| goto err; |
| } |
| if (listen(sock, 1) < 0) { |
| error_set_errno(errp, errno, QERR_SOCKET_LISTEN_FAILED); |
| goto err; |
| } |
| |
| return sock; |
| |
| err: |
| closesocket(sock); |
| return -1; |
| } |
| |
| int unix_connect_opts(QemuOpts *opts, Error **errp, |
| NonBlockingConnectHandler *callback, void *opaque) |
| { |
| struct sockaddr_un un; |
| const char *path = qemu_opt_get(opts, "path"); |
| ConnectState *connect_state = NULL; |
| int sock, rc; |
| |
| if (NULL == path) { |
| error_setg(errp, "unix connect: no path specified\n"); |
| return -1; |
| } |
| |
| sock = qemu_socket(PF_UNIX, SOCK_STREAM, 0); |
| if (sock < 0) { |
| error_set_errno(errp, errno, QERR_SOCKET_CREATE_FAILED); |
| return -1; |
| } |
| if (callback != NULL) { |
| connect_state = g_malloc0(sizeof(*connect_state)); |
| connect_state->callback = callback; |
| connect_state->opaque = opaque; |
| socket_set_nonblock(sock); |
| } |
| |
| memset(&un, 0, sizeof(un)); |
| un.sun_family = AF_UNIX; |
| snprintf(un.sun_path, sizeof(un.sun_path), "%s", path); |
| |
| /* connect to peer */ |
| do { |
| rc = 0; |
| if (connect(sock, (struct sockaddr *) &un, sizeof(un)) < 0) { |
| rc = -socket_error(); |
| } |
| } while (rc == -EINTR); |
| |
| if (connect_state != NULL && QEMU_SOCKET_RC_INPROGRESS(rc)) { |
| connect_state->fd = sock; |
| qemu_set_fd_handler2(sock, NULL, NULL, wait_for_connect, |
| connect_state); |
| return sock; |
| } else if (rc >= 0) { |
| /* non blocking socket immediate success, call callback */ |
| if (callback != NULL) { |
| callback(sock, opaque); |
| } |
| } |
| |
| if (rc < 0) { |
| error_set_errno(errp, -rc, QERR_SOCKET_CONNECT_FAILED); |
| close(sock); |
| sock = -1; |
| } |
| |
| g_free(connect_state); |
| return sock; |
| } |
| |
| #else |
| |
| int unix_listen_opts(QemuOpts *opts, Error **errp) |
| { |
| error_setg(errp, "unix sockets are not available on windows"); |
| errno = ENOTSUP; |
| return -1; |
| } |
| |
| int unix_connect_opts(QemuOpts *opts, Error **errp, |
| NonBlockingConnectHandler *callback, void *opaque) |
| { |
| error_setg(errp, "unix sockets are not available on windows"); |
| errno = ENOTSUP; |
| return -1; |
| } |
| #endif |
| |
| /* compatibility wrapper */ |
| int unix_listen(const char *str, char *ostr, int olen, Error **errp) |
| { |
| QemuOpts *opts; |
| char *path, *optstr; |
| int sock, len; |
| |
| opts = qemu_opts_create_nofail(&dummy_opts); |
| |
| optstr = strchr(str, ','); |
| if (optstr) { |
| len = optstr - str; |
| if (len) { |
| path = g_malloc(len+1); |
| snprintf(path, len+1, "%.*s", len, str); |
| qemu_opt_set(opts, "path", path); |
| g_free(path); |
| } |
| } else { |
| qemu_opt_set(opts, "path", str); |
| } |
| |
| sock = unix_listen_opts(opts, errp); |
| |
| if (sock != -1 && ostr) |
| snprintf(ostr, olen, "%s%s", qemu_opt_get(opts, "path"), optstr ? optstr : ""); |
| qemu_opts_del(opts); |
| return sock; |
| } |
| |
| int unix_connect(const char *path, Error **errp) |
| { |
| QemuOpts *opts; |
| int sock; |
| |
| opts = qemu_opts_create_nofail(&dummy_opts); |
| qemu_opt_set(opts, "path", path); |
| sock = unix_connect_opts(opts, errp, NULL, NULL); |
| qemu_opts_del(opts); |
| return sock; |
| } |
| |
| |
| int unix_nonblocking_connect(const char *path, |
| NonBlockingConnectHandler *callback, |
| void *opaque, Error **errp) |
| { |
| QemuOpts *opts; |
| int sock = -1; |
| |
| g_assert(callback != NULL); |
| |
| opts = qemu_opts_create_nofail(&dummy_opts); |
| qemu_opt_set(opts, "path", path); |
| sock = unix_connect_opts(opts, errp, callback, opaque); |
| qemu_opts_del(opts); |
| return sock; |
| } |
| |
| SocketAddress *socket_parse(const char *str, Error **errp) |
| { |
| SocketAddress *addr = NULL; |
| |
| addr = g_new(SocketAddress, 1); |
| if (strstart(str, "unix:", NULL)) { |
| if (str[5] == '\0') { |
| error_setg(errp, "invalid Unix socket address\n"); |
| goto fail; |
| } else { |
| addr->kind = SOCKET_ADDRESS_KIND_UNIX; |
| addr->q_unix = g_new(UnixSocketAddress, 1); |
| addr->q_unix->path = g_strdup(str + 5); |
| } |
| } else if (strstart(str, "fd:", NULL)) { |
| if (str[3] == '\0') { |
| error_setg(errp, "invalid file descriptor address\n"); |
| goto fail; |
| } else { |
| addr->kind = SOCKET_ADDRESS_KIND_FD; |
| addr->fd = g_new(String, 1); |
| addr->fd->str = g_strdup(str + 3); |
| } |
| } else { |
| addr->kind = SOCKET_ADDRESS_KIND_INET; |
| addr->inet = g_new(InetSocketAddress, 1); |
| addr->inet = inet_parse(str, errp); |
| if (addr->inet == NULL) { |
| goto fail; |
| } |
| } |
| return addr; |
| |
| fail: |
| qapi_free_SocketAddress(addr); |
| return NULL; |
| } |
| |
| int socket_connect(SocketAddress *addr, Error **errp, |
| NonBlockingConnectHandler *callback, void *opaque) |
| { |
| QemuOpts *opts; |
| int fd; |
| |
| opts = qemu_opts_create_nofail(&dummy_opts); |
| switch (addr->kind) { |
| case SOCKET_ADDRESS_KIND_INET: |
| inet_addr_to_opts(opts, addr->inet); |
| fd = inet_connect_opts(opts, errp, callback, opaque); |
| break; |
| |
| case SOCKET_ADDRESS_KIND_UNIX: |
| qemu_opt_set(opts, "path", addr->q_unix->path); |
| fd = unix_connect_opts(opts, errp, callback, opaque); |
| break; |
| |
| case SOCKET_ADDRESS_KIND_FD: |
| fd = monitor_get_fd(cur_mon, addr->fd->str, errp); |
| if (callback) { |
| callback(fd, opaque); |
| } |
| break; |
| |
| default: |
| abort(); |
| } |
| qemu_opts_del(opts); |
| return fd; |
| } |
| |
| int socket_listen(SocketAddress *addr, Error **errp) |
| { |
| QemuOpts *opts; |
| int fd; |
| |
| opts = qemu_opts_create_nofail(&dummy_opts); |
| switch (addr->kind) { |
| case SOCKET_ADDRESS_KIND_INET: |
| inet_addr_to_opts(opts, addr->inet); |
| fd = inet_listen_opts(opts, 0, errp); |
| break; |
| |
| case SOCKET_ADDRESS_KIND_UNIX: |
| qemu_opt_set(opts, "path", addr->q_unix->path); |
| fd = unix_listen_opts(opts, errp); |
| break; |
| |
| case SOCKET_ADDRESS_KIND_FD: |
| fd = monitor_get_fd(cur_mon, addr->fd->str, errp); |
| break; |
| |
| default: |
| abort(); |
| } |
| qemu_opts_del(opts); |
| return fd; |
| } |
| |
| #ifdef _WIN32 |
| static void socket_cleanup(void) |
| { |
| WSACleanup(); |
| } |
| #endif |
| |
| int socket_init(void) |
| { |
| #ifdef _WIN32 |
| WSADATA Data; |
| int ret, err; |
| |
| ret = WSAStartup(MAKEWORD(2,2), &Data); |
| if (ret != 0) { |
| err = WSAGetLastError(); |
| fprintf(stderr, "WSAStartup: %d\n", err); |
| return -1; |
| } |
| atexit(socket_cleanup); |
| #endif |
| return 0; |
| } |