net/socket.c

   1 /*
   2  * QEMU System Emulator
   3  *
   4  * Copyright (c) 2003-2008 Fabrice Bellard
   5  *
   6  * Permission is hereby granted, free of charge, to any person obtaining a copy
   7  * of this software and associated documentation files (the "Software"), to deal
   8  * in the Software without restriction, including without limitation the rights
   9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10  * copies of the Software, and to permit persons to whom the Software is
  11  * furnished to do so, subject to the following conditions:
  12  *
  13  * The above copyright notice and this permission notice shall be included in
  14  * all copies or substantial portions of the Software.
  15  *
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22  * THE SOFTWARE.
  23  */
  24 #include "net/socket.h"
  25
  26 #include "config-host.h"
  27
  28 #include "net.h"
  29 #include "qemu-char.h"
  30 #include "qemu-common.h"
  31 #include "qemu-error.h"
  32 #include "qemu-option.h"
  33 #include "qemu_socket.h"
  34
  35 typedef struct NetSocketState {
  36     VLANClientState nc;
  37     int fd;
  38     int state; /* 0 = getting length, 1 = getting data */
  39     unsigned int index;
  40     unsigned int packet_len;
  41     uint8_t buf[4096];
  42     struct sockaddr_in dgram_dst; /* contains inet host and port destination iff connectionless (SOCK_DGRAM) */
  43 } NetSocketState;
  44
  45 typedef struct NetSocketListenState {
  46     VLANState *vlan;
  47     char *model;
  48     char *name;
  49     int fd;
  50 } NetSocketListenState;
  51
  52 /* XXX: we consider we can send the whole packet without blocking */
  53 static ssize_t net_socket_receive(VLANClientState *nc, const uint8_t *buf, size_t size)
  54 {
  55     NetSocketState *s = DO_UPCAST(NetSocketState, nc, nc);
  56     uint32_t len;
  57     len = htonl(size);
  58
  59     send_all(s->fd, (const uint8_t *)&len, sizeof(len));
  60     return send_all(s->fd, buf, size);
  61 }
  62
  63 static ssize_t net_socket_receive_dgram(VLANClientState *nc, const uint8_t *buf, size_t size)
  64 {
  65     NetSocketState *s = DO_UPCAST(NetSocketState, nc, nc);
  66
  67     return sendto(s->fd, (const void *)buf, size, 0,
  68                   (struct sockaddr *)&s->dgram_dst, sizeof(s->dgram_dst));
  69 }
  70
  71 static void net_socket_send(void *opaque)
  72 {
  73     NetSocketState *s = opaque;
  74     int size, err;
  75     unsigned l;
  76     uint8_t buf1[4096];
  77     const uint8_t *buf;
  78
  79     size = qemu_recv(s->fd, buf1, sizeof(buf1), 0);
  80     if (size < 0) {
  81         err = socket_error();
  82         if (err != EWOULDBLOCK)
  83             goto eoc;
  84     } else if (size == 0) {
  85         /* end of connection */
  86     eoc:
  87         qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
  88         closesocket(s->fd);
  89         return;
  90     }
  91     buf = buf1;
  92     while (size > 0) {
  93         /* reassemble a packet from the network */
  94         switch(s->state) {
  95         case 0:
  96             l = 4 - s->index;
  97             if (l > size)
  98                 l = size;
  99             memcpy(s->buf + s->index, buf, l);
 100             buf += l;
 101             size -= l;
 102             s->index += l;
 103             if (s->index == 4) {
 104                 /* got length */
 105                 s->packet_len = ntohl(*(uint32_t *)s->buf);
 106                 s->index = 0;
 107                 s->state = 1;
 108             }
 109             break;
 110         case 1:
 111             l = s->packet_len - s->index;
 112             if (l > size)
 113                 l = size;
 114             if (s->index + l <= sizeof(s->buf)) {
 115                 memcpy(s->buf + s->index, buf, l);
 116             } else {
 117                 fprintf(stderr, "serious error: oversized packet received,"
 118                     "connection terminated.\n");
 119                 s->state = 0;
 120                 goto eoc;
 121             }
 122
 123             s->index += l;
 124             buf += l;
 125             size -= l;
 126             if (s->index >= s->packet_len) {
 127                 qemu_send_packet(&s->nc, s->buf, s->packet_len);
 128                 s->index = 0;
 129                 s->state = 0;
 130             }
 131             break;
 132         }
 133     }
 134 }
 135
 136 static void net_socket_send_dgram(void *opaque)
 137 {
 138     NetSocketState *s = opaque;
 139     int size;
 140
 141     size = qemu_recv(s->fd, s->buf, sizeof(s->buf), 0);
 142     if (size < 0)
 143         return;
 144     if (size == 0) {
 145         /* end of connection */
 146         qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
 147         return;
 148     }
 149     qemu_send_packet(&s->nc, s->buf, size);
 150 }
 151
 152 static int net_socket_mcast_create(struct sockaddr_in *mcastaddr, struct in_addr *localaddr)
 153 {
 154     struct ip_mreq imr;
 155     int fd;
 156     int val, ret;
 157 #ifdef __OpenBSD__
 158     unsigned char loop;
 159 #else
 160     int loop;
 161 #endif
 162
 163     if (!IN_MULTICAST(ntohl(mcastaddr->sin_addr.s_addr))) {
 164         fprintf(stderr, "qemu: error: specified mcastaddr \"%s\" (0x%08x) "
 165                 "does not contain a multicast address\n",
 166                 inet_ntoa(mcastaddr->sin_addr),
 167                 (int)ntohl(mcastaddr->sin_addr.s_addr));
 168         return -1;
 169
 170     }
 171     fd = qemu_socket(PF_INET, SOCK_DGRAM, 0);
 172     if (fd < 0) {
 173         perror("socket(PF_INET, SOCK_DGRAM)");
 174         return -1;
 175     }
 176
 177     val = 1;
 178     ret=setsockopt(fd, SOL_SOCKET, SO_REUSEADDR,
 179                    (const char *)&val, sizeof(val));
 180     if (ret < 0) {
 181         perror("setsockopt(SOL_SOCKET, SO_REUSEADDR)");
 182         goto fail;
 183     }
 184
 185     ret = bind(fd, (struct sockaddr *)mcastaddr, sizeof(*mcastaddr));
 186     if (ret < 0) {
 187         perror("bind");
 188         goto fail;
 189     }
 190
 191     /* Add host to multicast group */
 192     imr.imr_multiaddr = mcastaddr->sin_addr;
 193     if (localaddr) {
 194         imr.imr_interface = *localaddr;
 195     } else {
 196         imr.imr_interface.s_addr = htonl(INADDR_ANY);
 197     }
 198
 199     ret = setsockopt(fd, IPPROTO_IP, IP_ADD_MEMBERSHIP,
 200                      (const char *)&imr, sizeof(struct ip_mreq));
 201     if (ret < 0) {
 202         perror("setsockopt(IP_ADD_MEMBERSHIP)");
 203         goto fail;
 204     }
 205
 206     /* Force mcast msgs to loopback (eg. several QEMUs in same host */
 207     loop = 1;
 208     ret=setsockopt(fd, IPPROTO_IP, IP_MULTICAST_LOOP,
 209                    (const char *)&loop, sizeof(loop));
 210     if (ret < 0) {
 211         perror("setsockopt(SOL_IP, IP_MULTICAST_LOOP)");
 212         goto fail;
 213     }
 214
 215     /* If a bind address is given, only send packets from that address */
 216     if (localaddr != NULL) {
 217         ret = setsockopt(fd, IPPROTO_IP, IP_MULTICAST_IF,
 218                          (const char *)localaddr, sizeof(*localaddr));
 219         if (ret < 0) {
 220             perror("setsockopt(IP_MULTICAST_IF)");
 221             goto fail;
 222         }
 223     }
 224
 225     socket_set_nonblock(fd);
 226     return fd;
 227 fail:
 228     if (fd >= 0)
 229         closesocket(fd);
 230     return -1;
 231 }
 232
 233 static void net_socket_cleanup(VLANClientState *nc)
 234 {
 235     NetSocketState *s = DO_UPCAST(NetSocketState, nc, nc);
 236     qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
 237     close(s->fd);
 238 }
 239
 240 static NetClientInfo net_dgram_socket_info = {
 241     .type = NET_CLIENT_TYPE_SOCKET,
 242     .size = sizeof(NetSocketState),
 243     .receive = net_socket_receive_dgram,
 244     .cleanup = net_socket_cleanup,
 245 };
 246
 247 static NetSocketState *net_socket_fd_init_dgram(VLANState *vlan,
 248                                                 const char *model,
 249                                                 const char *name,
 250                                                 int fd, int is_connected)
 251 {
 252     struct sockaddr_in saddr;
 253     int newfd;
 254     socklen_t saddr_len;
 255     VLANClientState *nc;
 256     NetSocketState *s;
 257
 258     /* fd passed: multicast: "learn" dgram_dst address from bound address and save it
 259      * Because this may be "shared" socket from a "master" process, datagrams would be recv()
 260      * by ONLY ONE process: we must "clone" this dgram socket --jjo
 261      */
 262
 263     if (is_connected) {
 264         if (getsockname(fd, (struct sockaddr *) &saddr, &saddr_len) == 0) {
 265             /* must be bound */
 266             if (saddr.sin_addr.s_addr == 0) {
 267                 fprintf(stderr, "qemu: error: init_dgram: fd=%d unbound, "
 268                         "cannot setup multicast dst addr\n", fd);
 269                 goto err;
 270             }
 271             /* clone dgram socket */
 272             newfd = net_socket_mcast_create(&saddr, NULL);
 273             if (newfd < 0) {
 274                 /* error already reported by net_socket_mcast_create() */
 275                 goto err;
 276             }
 277             /* clone newfd to fd, close newfd */
 278             dup2(newfd, fd);
 279             close(newfd);
 280
 281         } else {
 282             fprintf(stderr,
 283                     "qemu: error: init_dgram: fd=%d failed getsockname(): %s\n",
 284                     fd, strerror(errno));
 285             goto err;
 286         }
 287     }
 288
 289     nc = qemu_new_net_client(&net_dgram_socket_info, vlan, NULL, model, name);
 290
 291     snprintf(nc->info_str, sizeof(nc->info_str),
 292             "socket: fd=%d (%s mcast=%s:%d)",
 293             fd, is_connected ? "cloned" : "",
 294             inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
 295
 296     s = DO_UPCAST(NetSocketState, nc, nc);
 297
 298     s->fd = fd;
 299
 300     qemu_set_fd_handler(s->fd, net_socket_send_dgram, NULL, s);
 301
 302     /* mcast: save bound address as dst */
 303     if (is_connected) s->dgram_dst=saddr;
 304
 305     return s;
 306
 307 err:
 308     closesocket(fd);
 309     return NULL;
 310 }
 311
 312 static void net_socket_connect(void *opaque)
 313 {
 314     NetSocketState *s = opaque;
 315     qemu_set_fd_handler(s->fd, net_socket_send, NULL, s);
 316 }
 317
 318 static NetClientInfo net_socket_info = {
 319     .type = NET_CLIENT_TYPE_SOCKET,
 320     .size = sizeof(NetSocketState),
 321     .receive = net_socket_receive,
 322     .cleanup = net_socket_cleanup,
 323 };
 324
 325 static NetSocketState *net_socket_fd_init_stream(VLANState *vlan,
 326                                                  const char *model,
 327                                                  const char *name,
 328                                                  int fd, int is_connected)
 329 {
 330     VLANClientState *nc;
 331     NetSocketState *s;
 332
 333     nc = qemu_new_net_client(&net_socket_info, vlan, NULL, model, name);
 334
 335     snprintf(nc->info_str, sizeof(nc->info_str), "socket: fd=%d", fd);
 336
 337     s = DO_UPCAST(NetSocketState, nc, nc);
 338
 339     s->fd = fd;
 340
 341     if (is_connected) {
 342         net_socket_connect(s);
 343     } else {
 344         qemu_set_fd_handler(s->fd, NULL, net_socket_connect, s);
 345     }
 346     return s;
 347 }
 348
 349 static NetSocketState *net_socket_fd_init(VLANState *vlan,
 350                                           const char *model, const char *name,
 351                                           int fd, int is_connected)
 352 {
 353     int so_type = -1, optlen=sizeof(so_type);
 354
 355     if(getsockopt(fd, SOL_SOCKET, SO_TYPE, (char *)&so_type,
 356         (socklen_t *)&optlen)< 0) {
 357         fprintf(stderr, "qemu: error: getsockopt(SO_TYPE) for fd=%d failed\n",
 358                 fd);
 359         closesocket(fd);
 360         return NULL;
 361     }
 362     switch(so_type) {
 363     case SOCK_DGRAM:
 364         return net_socket_fd_init_dgram(vlan, model, name, fd, is_connected);
 365     case SOCK_STREAM:
 366         return net_socket_fd_init_stream(vlan, model, name, fd, is_connected);
 367     default:
 368         /* who knows ... this could be a eg. a pty, do warn and continue as stream */
 369         fprintf(stderr, "qemu: warning: socket type=%d for fd=%d is not SOCK_DGRAM or SOCK_STREAM\n", so_type, fd);
 370         return net_socket_fd_init_stream(vlan, model, name, fd, is_connected);
 371     }
 372     return NULL;
 373 }
 374
 375 static void net_socket_accept(void *opaque)
 376 {
 377     NetSocketListenState *s = opaque;
 378     NetSocketState *s1;
 379     struct sockaddr_in saddr;
 380     socklen_t len;
 381     int fd;
 382
 383     for(;;) {
 384         len = sizeof(saddr);
 385         fd = qemu_accept(s->fd, (struct sockaddr *)&saddr, &len);
 386         if (fd < 0 && errno != EINTR) {
 387             return;
 388         } else if (fd >= 0) {
 389             break;
 390         }
 391     }
 392     s1 = net_socket_fd_init(s->vlan, s->model, s->name, fd, 1);
 393     if (s1) {
 394         snprintf(s1->nc.info_str, sizeof(s1->nc.info_str),
 395                  "socket: connection from %s:%d",
 396                  inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
 397     }
 398 }
 399
 400 static int net_socket_listen_init(VLANState *vlan,
 401                                   const char *model,
 402                                   const char *name,
 403                                   const char *host_str)
 404 {
 405     NetSocketListenState *s;
 406     int fd, val, ret;
 407     struct sockaddr_in saddr;
 408
 409     if (parse_host_port(&saddr, host_str) < 0)
 410         return -1;
 411
 412     s = g_malloc0(sizeof(NetSocketListenState));
 413
 414     fd = qemu_socket(PF_INET, SOCK_STREAM, 0);
 415     if (fd < 0) {
 416         perror("socket");
 417         g_free(s);
 418         return -1;
 419     }
 420     socket_set_nonblock(fd);
 421
 422     /* allow fast reuse */
 423     val = 1;
 424     setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, (const char *)&val, sizeof(val));
 425
 426     ret = bind(fd, (struct sockaddr *)&saddr, sizeof(saddr));
 427     if (ret < 0) {
 428         perror("bind");
 429         g_free(s);
 430         return -1;
 431     }
 432     ret = listen(fd, 0);
 433     if (ret < 0) {
 434         perror("listen");
 435         g_free(s);
 436         return -1;
 437     }
 438     s->vlan = vlan;
 439     s->model = g_strdup(model);
 440     s->name = name ? g_strdup(name) : NULL;
 441     s->fd = fd;
 442     qemu_set_fd_handler(fd, net_socket_accept, NULL, s);
 443     return 0;
 444 }
 445
 446 static int net_socket_connect_init(VLANState *vlan,
 447                                    const char *model,
 448                                    const char *name,
 449                                    const char *host_str)
 450 {
 451     NetSocketState *s;
 452     int fd, connected, ret, err;
 453     struct sockaddr_in saddr;
 454
 455     if (parse_host_port(&saddr, host_str) < 0)
 456         return -1;
 457
 458     fd = qemu_socket(PF_INET, SOCK_STREAM, 0);
 459     if (fd < 0) {
 460         perror("socket");
 461         return -1;
 462     }
 463     socket_set_nonblock(fd);
 464
 465     connected = 0;
 466     for(;;) {
 467         ret = connect(fd, (struct sockaddr *)&saddr, sizeof(saddr));
 468         if (ret < 0) {
 469             err = socket_error();
 470             if (err == EINTR || err == EWOULDBLOCK) {
 471             } else if (err == EINPROGRESS) {
 472                 break;
 473 #ifdef _WIN32
 474             } else if (err == WSAEALREADY || err == WSAEINVAL) {
 475                 break;
 476 #endif
 477             } else {
 478                 perror("connect");
 479                 closesocket(fd);
 480                 return -1;
 481             }
 482         } else {
 483             connected = 1;
 484             break;
 485         }
 486     }
 487     s = net_socket_fd_init(vlan, model, name, fd, connected);
 488     if (!s)
 489         return -1;
 490     snprintf(s->nc.info_str, sizeof(s->nc.info_str),
 491              "socket: connect to %s:%d",
 492              inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
 493     return 0;
 494 }
 495
 496 static int net_socket_mcast_init(VLANState *vlan,
 497                                  const char *model,
 498                                  const char *name,
 499                                  const char *host_str,
 500                                  const char *localaddr_str)
 501 {
 502     NetSocketState *s;
 503     int fd;
 504     struct sockaddr_in saddr;
 505     struct in_addr localaddr, *param_localaddr;
 506
 507     if (parse_host_port(&saddr, host_str) < 0)
 508         return -1;
 509
 510     if (localaddr_str != NULL) {
 511         if (inet_aton(localaddr_str, &localaddr) == 0)
 512             return -1;
 513         param_localaddr = &localaddr;
 514     } else {
 515         param_localaddr = NULL;
 516     }
 517
 518     fd = net_socket_mcast_create(&saddr, param_localaddr);
 519     if (fd < 0)
 520         return -1;
 521
 522     s = net_socket_fd_init(vlan, model, name, fd, 0);
 523     if (!s)
 524         return -1;
 525
 526     s->dgram_dst = saddr;
 527
 528     snprintf(s->nc.info_str, sizeof(s->nc.info_str),
 529              "socket: mcast=%s:%d",
 530              inet_ntoa(saddr.sin_addr), ntohs(saddr.sin_port));
 531     return 0;
 532
 533 }
 534
 535 int net_init_socket(QemuOpts *opts,
 536                     Monitor *mon,
 537                     const char *name,
 538                     VLANState *vlan)
 539 {
 540     if (qemu_opt_get(opts, "fd")) {
 541         int fd;
 542
 543         if (qemu_opt_get(opts, "listen") ||
 544             qemu_opt_get(opts, "connect") ||
 545             qemu_opt_get(opts, "mcast") ||
 546             qemu_opt_get(opts, "localaddr")) {
 547             error_report("listen=, connect=, mcast= and localaddr= is invalid with fd=");
 548             return -1;
 549         }
 550
 551         fd = net_handle_fd_param(mon, qemu_opt_get(opts, "fd"));
 552         if (fd == -1) {
 553             return -1;
 554         }
 555
 556         if (!net_socket_fd_init(vlan, "socket", name, fd, 1)) {
 557             return -1;
 558         }
 559     } else if (qemu_opt_get(opts, "listen")) {
 560         const char *listen;
 561
 562         if (qemu_opt_get(opts, "fd") ||
 563             qemu_opt_get(opts, "connect") ||
 564             qemu_opt_get(opts, "mcast") ||
 565             qemu_opt_get(opts, "localaddr")) {
 566             error_report("fd=, connect=, mcast= and localaddr= is invalid with listen=");
 567             return -1;
 568         }
 569
 570         listen = qemu_opt_get(opts, "listen");
 571
 572         if (net_socket_listen_init(vlan, "socket", name, listen) == -1) {
 573             return -1;
 574         }
 575     } else if (qemu_opt_get(opts, "connect")) {
 576         const char *connect;
 577
 578         if (qemu_opt_get(opts, "fd") ||
 579             qemu_opt_get(opts, "listen") ||
 580             qemu_opt_get(opts, "mcast") ||
 581             qemu_opt_get(opts, "localaddr")) {
 582             error_report("fd=, listen=, mcast= and localaddr= is invalid with connect=");
 583             return -1;
 584         }
 585
 586         connect = qemu_opt_get(opts, "connect");
 587
 588         if (net_socket_connect_init(vlan, "socket", name, connect) == -1) {
 589             return -1;
 590         }
 591     } else if (qemu_opt_get(opts, "mcast")) {
 592         const char *mcast, *localaddr;
 593
 594         if (qemu_opt_get(opts, "fd") ||
 595             qemu_opt_get(opts, "connect") ||
 596             qemu_opt_get(opts, "listen")) {
 597             error_report("fd=, connect= and listen= is invalid with mcast=");
 598             return -1;
 599         }
 600
 601         mcast = qemu_opt_get(opts, "mcast");
 602         localaddr = qemu_opt_get(opts, "localaddr");
 603
 604         if (net_socket_mcast_init(vlan, "socket", name, mcast, localaddr) == -1) {
 605             return -1;
 606         }
 607     } else {
 608         error_report("-socket requires fd=, listen=, connect= or mcast=");
 609         return -1;
 610     }
 611
 612     return 0;
 613 }