4 * Copyright (c) 2003-2008 Fabrice Bellard
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:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
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
24 #include "config-host.h"
28 #include "monitor/monitor.h"
29 #include "qemu-common.h"
30 #include "qemu/error-report.h"
31 #include "qemu/option.h"
32 #include "qemu/sockets.h"
34 #include "qemu/main-loop.h"
36 typedef struct NetSocketState
{
40 int state
; /* 0 = getting length, 1 = getting data */
42 unsigned int packet_len
;
43 unsigned int send_index
; /* number of bytes sent (only SOCK_STREAM) */
44 uint8_t buf
[NET_BUFSIZE
];
45 struct sockaddr_in dgram_dst
; /* contains inet host and port destination iff connectionless (SOCK_DGRAM) */
46 IOHandler
*send_fn
; /* differs between SOCK_STREAM/SOCK_DGRAM */
47 bool read_poll
; /* waiting to receive data? */
48 bool write_poll
; /* waiting to transmit data? */
51 static void net_socket_accept(void *opaque
);
52 static void net_socket_writable(void *opaque
);
54 /* Only read packets from socket when peer can receive them */
55 static int net_socket_can_send(void *opaque
)
57 NetSocketState
*s
= opaque
;
59 return qemu_can_send_packet(&s
->nc
);
62 static void net_socket_update_fd_handler(NetSocketState
*s
)
64 qemu_set_fd_handler2(s
->fd
,
65 s
->read_poll
? net_socket_can_send
: NULL
,
66 s
->read_poll
? s
->send_fn
: NULL
,
67 s
->write_poll
? net_socket_writable
: NULL
,
71 static void net_socket_read_poll(NetSocketState
*s
, bool enable
)
73 s
->read_poll
= enable
;
74 net_socket_update_fd_handler(s
);
77 static void net_socket_write_poll(NetSocketState
*s
, bool enable
)
79 s
->write_poll
= enable
;
80 net_socket_update_fd_handler(s
);
83 static void net_socket_writable(void *opaque
)
85 NetSocketState
*s
= opaque
;
87 net_socket_write_poll(s
, false);
89 qemu_flush_queued_packets(&s
->nc
);
92 static ssize_t
net_socket_receive(NetClientState
*nc
, const uint8_t *buf
, size_t size
)
94 NetSocketState
*s
= DO_UPCAST(NetSocketState
, nc
, nc
);
95 uint32_t len
= htonl(size
);
96 struct iovec iov
[] = {
99 .iov_len
= sizeof(len
),
101 .iov_base
= (void *)buf
,
108 remaining
= iov_size(iov
, 2) - s
->send_index
;
109 ret
= iov_send(s
->fd
, iov
, 2, s
->send_index
, remaining
);
111 if (ret
== -1 && errno
== EAGAIN
) {
112 ret
= 0; /* handled further down */
118 if (ret
< (ssize_t
)remaining
) {
119 s
->send_index
+= ret
;
120 net_socket_write_poll(s
, true);
127 static ssize_t
net_socket_receive_dgram(NetClientState
*nc
, const uint8_t *buf
, size_t size
)
129 NetSocketState
*s
= DO_UPCAST(NetSocketState
, nc
, nc
);
133 ret
= qemu_sendto(s
->fd
, buf
, size
, 0,
134 (struct sockaddr
*)&s
->dgram_dst
,
135 sizeof(s
->dgram_dst
));
136 } while (ret
== -1 && errno
== EINTR
);
138 if (ret
== -1 && errno
== EAGAIN
) {
139 net_socket_write_poll(s
, true);
145 static void net_socket_send(void *opaque
)
147 NetSocketState
*s
= opaque
;
150 uint8_t buf1
[NET_BUFSIZE
];
153 size
= qemu_recv(s
->fd
, buf1
, sizeof(buf1
), 0);
155 err
= socket_error();
156 if (err
!= EWOULDBLOCK
)
158 } else if (size
== 0) {
159 /* end of connection */
161 net_socket_read_poll(s
, false);
162 net_socket_write_poll(s
, false);
163 if (s
->listen_fd
!= -1) {
164 qemu_set_fd_handler(s
->listen_fd
, net_socket_accept
, NULL
, s
);
172 s
->nc
.link_down
= true;
173 memset(s
->buf
, 0, sizeof(s
->buf
));
174 memset(s
->nc
.info_str
, 0, sizeof(s
->nc
.info_str
));
180 /* reassemble a packet from the network */
186 memcpy(s
->buf
+ s
->index
, buf
, l
);
192 s
->packet_len
= ntohl(*(uint32_t *)s
->buf
);
198 l
= s
->packet_len
- s
->index
;
201 if (s
->index
+ l
<= sizeof(s
->buf
)) {
202 memcpy(s
->buf
+ s
->index
, buf
, l
);
204 fprintf(stderr
, "serious error: oversized packet received,"
205 "connection terminated.\n");
213 if (s
->index
>= s
->packet_len
) {
214 qemu_send_packet(&s
->nc
, s
->buf
, s
->packet_len
);
223 static void net_socket_send_dgram(void *opaque
)
225 NetSocketState
*s
= opaque
;
228 size
= qemu_recv(s
->fd
, s
->buf
, sizeof(s
->buf
), 0);
232 /* end of connection */
233 net_socket_read_poll(s
, false);
234 net_socket_write_poll(s
, false);
237 qemu_send_packet(&s
->nc
, s
->buf
, size
);
240 static int net_socket_mcast_create(struct sockaddr_in
*mcastaddr
, struct in_addr
*localaddr
)
251 if (!IN_MULTICAST(ntohl(mcastaddr
->sin_addr
.s_addr
))) {
252 fprintf(stderr
, "qemu: error: specified mcastaddr \"%s\" (0x%08x) "
253 "does not contain a multicast address\n",
254 inet_ntoa(mcastaddr
->sin_addr
),
255 (int)ntohl(mcastaddr
->sin_addr
.s_addr
));
259 fd
= qemu_socket(PF_INET
, SOCK_DGRAM
, 0);
261 perror("socket(PF_INET, SOCK_DGRAM)");
266 ret
= qemu_setsockopt(fd
, SOL_SOCKET
, SO_REUSEADDR
, &val
, sizeof(val
));
268 perror("setsockopt(SOL_SOCKET, SO_REUSEADDR)");
272 ret
= bind(fd
, (struct sockaddr
*)mcastaddr
, sizeof(*mcastaddr
));
278 /* Add host to multicast group */
279 imr
.imr_multiaddr
= mcastaddr
->sin_addr
;
281 imr
.imr_interface
= *localaddr
;
283 imr
.imr_interface
.s_addr
= htonl(INADDR_ANY
);
286 ret
= qemu_setsockopt(fd
, IPPROTO_IP
, IP_ADD_MEMBERSHIP
,
287 &imr
, sizeof(struct ip_mreq
));
289 perror("setsockopt(IP_ADD_MEMBERSHIP)");
293 /* Force mcast msgs to loopback (eg. several QEMUs in same host */
295 ret
= qemu_setsockopt(fd
, IPPROTO_IP
, IP_MULTICAST_LOOP
,
296 &loop
, sizeof(loop
));
298 perror("setsockopt(SOL_IP, IP_MULTICAST_LOOP)");
302 /* If a bind address is given, only send packets from that address */
303 if (localaddr
!= NULL
) {
304 ret
= qemu_setsockopt(fd
, IPPROTO_IP
, IP_MULTICAST_IF
,
305 localaddr
, sizeof(*localaddr
));
307 perror("setsockopt(IP_MULTICAST_IF)");
312 qemu_set_nonblock(fd
);
320 static void net_socket_cleanup(NetClientState
*nc
)
322 NetSocketState
*s
= DO_UPCAST(NetSocketState
, nc
, nc
);
324 net_socket_read_poll(s
, false);
325 net_socket_write_poll(s
, false);
329 if (s
->listen_fd
!= -1) {
330 qemu_set_fd_handler(s
->listen_fd
, NULL
, NULL
, NULL
);
331 closesocket(s
->listen_fd
);
336 static NetClientInfo net_dgram_socket_info
= {
337 .type
= NET_CLIENT_OPTIONS_KIND_SOCKET
,
338 .size
= sizeof(NetSocketState
),
339 .receive
= net_socket_receive_dgram
,
340 .cleanup
= net_socket_cleanup
,
343 static NetSocketState
*net_socket_fd_init_dgram(NetClientState
*peer
,
346 int fd
, int is_connected
)
348 struct sockaddr_in saddr
;
354 /* fd passed: multicast: "learn" dgram_dst address from bound address and save it
355 * Because this may be "shared" socket from a "master" process, datagrams would be recv()
356 * by ONLY ONE process: we must "clone" this dgram socket --jjo
360 if (getsockname(fd
, (struct sockaddr
*) &saddr
, &saddr_len
) == 0) {
362 if (saddr
.sin_addr
.s_addr
== 0) {
363 fprintf(stderr
, "qemu: error: init_dgram: fd=%d unbound, "
364 "cannot setup multicast dst addr\n", fd
);
367 /* clone dgram socket */
368 newfd
= net_socket_mcast_create(&saddr
, NULL
);
370 /* error already reported by net_socket_mcast_create() */
373 /* clone newfd to fd, close newfd */
379 "qemu: error: init_dgram: fd=%d failed getsockname(): %s\n",
380 fd
, strerror(errno
));
385 nc
= qemu_new_net_client(&net_dgram_socket_info
, peer
, model
, name
);
387 snprintf(nc
->info_str
, sizeof(nc
->info_str
),
388 "socket: fd=%d (%s mcast=%s:%d)",
389 fd
, is_connected
? "cloned" : "",
390 inet_ntoa(saddr
.sin_addr
), ntohs(saddr
.sin_port
));
392 s
= DO_UPCAST(NetSocketState
, nc
, nc
);
396 s
->send_fn
= net_socket_send_dgram
;
397 net_socket_read_poll(s
, true);
399 /* mcast: save bound address as dst */
401 s
->dgram_dst
= saddr
;
411 static void net_socket_connect(void *opaque
)
413 NetSocketState
*s
= opaque
;
414 s
->send_fn
= net_socket_send
;
415 net_socket_read_poll(s
, true);
418 static NetClientInfo net_socket_info
= {
419 .type
= NET_CLIENT_OPTIONS_KIND_SOCKET
,
420 .size
= sizeof(NetSocketState
),
421 .receive
= net_socket_receive
,
422 .cleanup
= net_socket_cleanup
,
425 static NetSocketState
*net_socket_fd_init_stream(NetClientState
*peer
,
428 int fd
, int is_connected
)
433 nc
= qemu_new_net_client(&net_socket_info
, peer
, model
, name
);
435 snprintf(nc
->info_str
, sizeof(nc
->info_str
), "socket: fd=%d", fd
);
437 s
= DO_UPCAST(NetSocketState
, nc
, nc
);
442 /* Disable Nagle algorithm on TCP sockets to reduce latency */
443 socket_set_nodelay(fd
);
446 net_socket_connect(s
);
448 qemu_set_fd_handler(s
->fd
, NULL
, net_socket_connect
, s
);
453 static NetSocketState
*net_socket_fd_init(NetClientState
*peer
,
454 const char *model
, const char *name
,
455 int fd
, int is_connected
)
457 int so_type
= -1, optlen
=sizeof(so_type
);
459 if(getsockopt(fd
, SOL_SOCKET
, SO_TYPE
, (char *)&so_type
,
460 (socklen_t
*)&optlen
)< 0) {
461 fprintf(stderr
, "qemu: error: getsockopt(SO_TYPE) for fd=%d failed\n",
468 return net_socket_fd_init_dgram(peer
, model
, name
, fd
, is_connected
);
470 return net_socket_fd_init_stream(peer
, model
, name
, fd
, is_connected
);
472 /* who knows ... this could be a eg. a pty, do warn and continue as stream */
473 fprintf(stderr
, "qemu: warning: socket type=%d for fd=%d is not SOCK_DGRAM or SOCK_STREAM\n", so_type
, fd
);
474 return net_socket_fd_init_stream(peer
, model
, name
, fd
, is_connected
);
479 static void net_socket_accept(void *opaque
)
481 NetSocketState
*s
= opaque
;
482 struct sockaddr_in saddr
;
488 fd
= qemu_accept(s
->listen_fd
, (struct sockaddr
*)&saddr
, &len
);
489 if (fd
< 0 && errno
!= EINTR
) {
491 } else if (fd
>= 0) {
492 qemu_set_fd_handler(s
->listen_fd
, NULL
, NULL
, NULL
);
498 s
->nc
.link_down
= false;
499 net_socket_connect(s
);
500 snprintf(s
->nc
.info_str
, sizeof(s
->nc
.info_str
),
501 "socket: connection from %s:%d",
502 inet_ntoa(saddr
.sin_addr
), ntohs(saddr
.sin_port
));
505 static int net_socket_listen_init(NetClientState
*peer
,
508 const char *host_str
)
512 struct sockaddr_in saddr
;
515 if (parse_host_port(&saddr
, host_str
) < 0)
518 fd
= qemu_socket(PF_INET
, SOCK_STREAM
, 0);
523 qemu_set_nonblock(fd
);
525 /* allow fast reuse */
527 qemu_setsockopt(fd
, SOL_SOCKET
, SO_REUSEADDR
, &val
, sizeof(val
));
529 ret
= bind(fd
, (struct sockaddr
*)&saddr
, sizeof(saddr
));
542 nc
= qemu_new_net_client(&net_socket_info
, peer
, model
, name
);
543 s
= DO_UPCAST(NetSocketState
, nc
, nc
);
546 s
->nc
.link_down
= true;
548 qemu_set_fd_handler(s
->listen_fd
, net_socket_accept
, NULL
, s
);
552 static int net_socket_connect_init(NetClientState
*peer
,
555 const char *host_str
)
558 int fd
, connected
, ret
, err
;
559 struct sockaddr_in saddr
;
561 if (parse_host_port(&saddr
, host_str
) < 0)
564 fd
= qemu_socket(PF_INET
, SOCK_STREAM
, 0);
569 qemu_set_nonblock(fd
);
573 ret
= connect(fd
, (struct sockaddr
*)&saddr
, sizeof(saddr
));
575 err
= socket_error();
576 if (err
== EINTR
|| err
== EWOULDBLOCK
) {
577 } else if (err
== EINPROGRESS
) {
580 } else if (err
== WSAEALREADY
|| err
== WSAEINVAL
) {
593 s
= net_socket_fd_init(peer
, model
, name
, fd
, connected
);
596 snprintf(s
->nc
.info_str
, sizeof(s
->nc
.info_str
),
597 "socket: connect to %s:%d",
598 inet_ntoa(saddr
.sin_addr
), ntohs(saddr
.sin_port
));
602 static int net_socket_mcast_init(NetClientState
*peer
,
605 const char *host_str
,
606 const char *localaddr_str
)
610 struct sockaddr_in saddr
;
611 struct in_addr localaddr
, *param_localaddr
;
613 if (parse_host_port(&saddr
, host_str
) < 0)
616 if (localaddr_str
!= NULL
) {
617 if (inet_aton(localaddr_str
, &localaddr
) == 0)
619 param_localaddr
= &localaddr
;
621 param_localaddr
= NULL
;
624 fd
= net_socket_mcast_create(&saddr
, param_localaddr
);
628 s
= net_socket_fd_init(peer
, model
, name
, fd
, 0);
632 s
->dgram_dst
= saddr
;
634 snprintf(s
->nc
.info_str
, sizeof(s
->nc
.info_str
),
635 "socket: mcast=%s:%d",
636 inet_ntoa(saddr
.sin_addr
), ntohs(saddr
.sin_port
));
641 static int net_socket_udp_init(NetClientState
*peer
,
649 struct sockaddr_in laddr
, raddr
;
651 if (parse_host_port(&laddr
, lhost
) < 0) {
655 if (parse_host_port(&raddr
, rhost
) < 0) {
659 fd
= qemu_socket(PF_INET
, SOCK_DGRAM
, 0);
661 perror("socket(PF_INET, SOCK_DGRAM)");
665 ret
= qemu_setsockopt(fd
, SOL_SOCKET
, SO_REUSEADDR
,
668 perror("setsockopt(SOL_SOCKET, SO_REUSEADDR)");
672 ret
= bind(fd
, (struct sockaddr
*)&laddr
, sizeof(laddr
));
678 qemu_set_nonblock(fd
);
680 s
= net_socket_fd_init(peer
, model
, name
, fd
, 0);
685 s
->dgram_dst
= raddr
;
687 snprintf(s
->nc
.info_str
, sizeof(s
->nc
.info_str
),
689 inet_ntoa(raddr
.sin_addr
), ntohs(raddr
.sin_port
));
693 int net_init_socket(const NetClientOptions
*opts
, const char *name
,
694 NetClientState
*peer
)
696 const NetdevSocketOptions
*sock
;
698 assert(opts
->kind
== NET_CLIENT_OPTIONS_KIND_SOCKET
);
701 if (sock
->has_fd
+ sock
->has_listen
+ sock
->has_connect
+ sock
->has_mcast
+
702 sock
->has_udp
!= 1) {
703 error_report("exactly one of fd=, listen=, connect=, mcast= or udp="
708 if (sock
->has_localaddr
&& !sock
->has_mcast
&& !sock
->has_udp
) {
709 error_report("localaddr= is only valid with mcast= or udp=");
716 fd
= monitor_handle_fd_param(cur_mon
, sock
->fd
);
720 qemu_set_nonblock(fd
);
721 if (!net_socket_fd_init(peer
, "socket", name
, fd
, 1)) {
727 if (sock
->has_listen
) {
728 if (net_socket_listen_init(peer
, "socket", name
, sock
->listen
) == -1) {
734 if (sock
->has_connect
) {
735 if (net_socket_connect_init(peer
, "socket", name
, sock
->connect
) ==
742 if (sock
->has_mcast
) {
743 /* if sock->localaddr is missing, it has been initialized to "all bits
745 if (net_socket_mcast_init(peer
, "socket", name
, sock
->mcast
,
746 sock
->localaddr
) == -1) {
752 assert(sock
->has_udp
);
753 if (!sock
->has_localaddr
) {
754 error_report("localaddr= is mandatory with udp=");
757 if (net_socket_udp_init(peer
, "socket", name
, sock
->udp
, sock
->localaddr
) ==