2 * QEMU I/O channels sockets driver
4 * Copyright (c) 2015 Red Hat, Inc.
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
21 #include "io/channel-socket.h"
22 #include "io/channel-watch.h"
25 #define SOCKET_MAX_FDS 16
28 qio_channel_socket_get_local_address(QIOChannelSocket
*ioc
,
31 return socket_sockaddr_to_address(&ioc
->localAddr
,
37 qio_channel_socket_get_remote_address(QIOChannelSocket
*ioc
,
40 return socket_sockaddr_to_address(&ioc
->remoteAddr
,
46 qio_channel_socket_new(void)
48 QIOChannelSocket
*sioc
;
51 sioc
= QIO_CHANNEL_SOCKET(object_new(TYPE_QIO_CHANNEL_SOCKET
));
54 ioc
= QIO_CHANNEL(sioc
);
55 ioc
->features
|= (1 << QIO_CHANNEL_FEATURE_SHUTDOWN
);
57 trace_qio_channel_socket_new(sioc
);
64 qio_channel_socket_set_fd(QIOChannelSocket
*sioc
,
69 error_setg(errp
, "Socket is already open");
74 sioc
->remoteAddrLen
= sizeof(sioc
->remoteAddr
);
75 sioc
->localAddrLen
= sizeof(sioc
->localAddr
);
78 if (getpeername(fd
, (struct sockaddr
*)&sioc
->remoteAddr
,
79 &sioc
->remoteAddrLen
) < 0) {
80 if (socket_error() == ENOTCONN
) {
81 memset(&sioc
->remoteAddr
, 0, sizeof(sioc
->remoteAddr
));
82 sioc
->remoteAddrLen
= sizeof(sioc
->remoteAddr
);
84 error_setg_errno(errp
, socket_error(),
85 "Unable to query remote socket address");
90 if (getsockname(fd
, (struct sockaddr
*)&sioc
->localAddr
,
91 &sioc
->localAddrLen
) < 0) {
92 error_setg_errno(errp
, socket_error(),
93 "Unable to query local socket address");
98 if (sioc
->localAddr
.ss_family
== AF_UNIX
) {
99 QIOChannel
*ioc
= QIO_CHANNEL(sioc
);
100 ioc
->features
|= (1 << QIO_CHANNEL_FEATURE_FD_PASS
);
107 sioc
->fd
= -1; /* Let the caller close FD on failure */
112 qio_channel_socket_new_fd(int fd
,
115 QIOChannelSocket
*ioc
;
117 ioc
= qio_channel_socket_new();
118 if (qio_channel_socket_set_fd(ioc
, fd
, errp
) < 0) {
119 object_unref(OBJECT(ioc
));
123 trace_qio_channel_socket_new_fd(ioc
, fd
);
129 int qio_channel_socket_connect_sync(QIOChannelSocket
*ioc
,
135 trace_qio_channel_socket_connect_sync(ioc
, addr
);
136 fd
= socket_connect(addr
, errp
, NULL
, NULL
);
138 trace_qio_channel_socket_connect_fail(ioc
);
142 trace_qio_channel_socket_connect_complete(ioc
, fd
);
143 if (qio_channel_socket_set_fd(ioc
, fd
, errp
) < 0) {
152 static int qio_channel_socket_connect_worker(QIOTask
*task
,
156 QIOChannelSocket
*ioc
= QIO_CHANNEL_SOCKET(qio_task_get_source(task
));
157 SocketAddress
*addr
= opaque
;
160 ret
= qio_channel_socket_connect_sync(ioc
,
164 object_unref(OBJECT(ioc
));
169 void qio_channel_socket_connect_async(QIOChannelSocket
*ioc
,
171 QIOTaskFunc callback
,
173 GDestroyNotify destroy
)
175 QIOTask
*task
= qio_task_new(
176 OBJECT(ioc
), callback
, opaque
, destroy
);
177 SocketAddress
*addrCopy
;
179 qapi_copy_SocketAddress(&addrCopy
, addr
);
181 /* socket_connect() does a non-blocking connect(), but it
182 * still blocks in DNS lookups, so we must use a thread */
183 trace_qio_channel_socket_connect_async(ioc
, addr
);
184 qio_task_run_in_thread(task
,
185 qio_channel_socket_connect_worker
,
187 (GDestroyNotify
)qapi_free_SocketAddress
);
191 int qio_channel_socket_listen_sync(QIOChannelSocket
*ioc
,
197 trace_qio_channel_socket_listen_sync(ioc
, addr
);
198 fd
= socket_listen(addr
, errp
);
200 trace_qio_channel_socket_listen_fail(ioc
);
204 trace_qio_channel_socket_listen_complete(ioc
, fd
);
205 if (qio_channel_socket_set_fd(ioc
, fd
, errp
) < 0) {
214 static int qio_channel_socket_listen_worker(QIOTask
*task
,
218 QIOChannelSocket
*ioc
= QIO_CHANNEL_SOCKET(qio_task_get_source(task
));
219 SocketAddress
*addr
= opaque
;
222 ret
= qio_channel_socket_listen_sync(ioc
,
226 object_unref(OBJECT(ioc
));
231 void qio_channel_socket_listen_async(QIOChannelSocket
*ioc
,
233 QIOTaskFunc callback
,
235 GDestroyNotify destroy
)
237 QIOTask
*task
= qio_task_new(
238 OBJECT(ioc
), callback
, opaque
, destroy
);
239 SocketAddress
*addrCopy
;
241 qapi_copy_SocketAddress(&addrCopy
, addr
);
243 /* socket_listen() blocks in DNS lookups, so we must use a thread */
244 trace_qio_channel_socket_listen_async(ioc
, addr
);
245 qio_task_run_in_thread(task
,
246 qio_channel_socket_listen_worker
,
248 (GDestroyNotify
)qapi_free_SocketAddress
);
252 int qio_channel_socket_dgram_sync(QIOChannelSocket
*ioc
,
253 SocketAddress
*localAddr
,
254 SocketAddress
*remoteAddr
,
259 trace_qio_channel_socket_dgram_sync(ioc
, localAddr
, remoteAddr
);
260 fd
= socket_dgram(localAddr
, remoteAddr
, errp
);
262 trace_qio_channel_socket_dgram_fail(ioc
);
266 trace_qio_channel_socket_dgram_complete(ioc
, fd
);
267 if (qio_channel_socket_set_fd(ioc
, fd
, errp
) < 0) {
276 struct QIOChannelSocketDGramWorkerData
{
277 SocketAddress
*localAddr
;
278 SocketAddress
*remoteAddr
;
282 static void qio_channel_socket_dgram_worker_free(gpointer opaque
)
284 struct QIOChannelSocketDGramWorkerData
*data
= opaque
;
285 qapi_free_SocketAddress(data
->localAddr
);
286 qapi_free_SocketAddress(data
->remoteAddr
);
290 static int qio_channel_socket_dgram_worker(QIOTask
*task
,
294 QIOChannelSocket
*ioc
= QIO_CHANNEL_SOCKET(qio_task_get_source(task
));
295 struct QIOChannelSocketDGramWorkerData
*data
= opaque
;
298 /* socket_dgram() blocks in DNS lookups, so we must use a thread */
299 ret
= qio_channel_socket_dgram_sync(ioc
,
304 object_unref(OBJECT(ioc
));
309 void qio_channel_socket_dgram_async(QIOChannelSocket
*ioc
,
310 SocketAddress
*localAddr
,
311 SocketAddress
*remoteAddr
,
312 QIOTaskFunc callback
,
314 GDestroyNotify destroy
)
316 QIOTask
*task
= qio_task_new(
317 OBJECT(ioc
), callback
, opaque
, destroy
);
318 struct QIOChannelSocketDGramWorkerData
*data
= g_new0(
319 struct QIOChannelSocketDGramWorkerData
, 1);
321 qapi_copy_SocketAddress(&data
->localAddr
, localAddr
);
322 qapi_copy_SocketAddress(&data
->remoteAddr
, remoteAddr
);
324 trace_qio_channel_socket_dgram_async(ioc
, localAddr
, remoteAddr
);
325 qio_task_run_in_thread(task
,
326 qio_channel_socket_dgram_worker
,
328 qio_channel_socket_dgram_worker_free
);
333 qio_channel_socket_accept(QIOChannelSocket
*ioc
,
336 QIOChannelSocket
*cioc
;
338 cioc
= QIO_CHANNEL_SOCKET(object_new(TYPE_QIO_CHANNEL_SOCKET
));
340 cioc
->remoteAddrLen
= sizeof(ioc
->remoteAddr
);
341 cioc
->localAddrLen
= sizeof(ioc
->localAddr
);
344 trace_qio_channel_socket_accept(ioc
);
345 cioc
->fd
= accept(ioc
->fd
, (struct sockaddr
*)&cioc
->remoteAddr
,
346 &cioc
->remoteAddrLen
);
348 trace_qio_channel_socket_accept_fail(ioc
);
349 if (socket_error() == EINTR
) {
355 if (getsockname(cioc
->fd
, (struct sockaddr
*)&cioc
->localAddr
,
356 &cioc
->localAddrLen
) < 0) {
357 error_setg_errno(errp
, socket_error(),
358 "Unable to query local socket address");
363 if (cioc
->localAddr
.ss_family
== AF_UNIX
) {
364 QIO_CHANNEL(cioc
)->features
|= (1 << QIO_CHANNEL_FEATURE_FD_PASS
);
368 trace_qio_channel_socket_accept_complete(ioc
, cioc
, cioc
->fd
);
372 object_unref(OBJECT(cioc
));
376 static void qio_channel_socket_init(Object
*obj
)
378 QIOChannelSocket
*ioc
= QIO_CHANNEL_SOCKET(obj
);
382 static void qio_channel_socket_finalize(Object
*obj
)
384 QIOChannelSocket
*ioc
= QIO_CHANNEL_SOCKET(obj
);
393 static void qio_channel_socket_copy_fds(struct msghdr
*msg
,
394 int **fds
, size_t *nfds
)
396 struct cmsghdr
*cmsg
;
401 for (cmsg
= CMSG_FIRSTHDR(msg
); cmsg
; cmsg
= CMSG_NXTHDR(msg
, cmsg
)) {
405 if (cmsg
->cmsg_len
< CMSG_LEN(sizeof(int)) ||
406 cmsg
->cmsg_level
!= SOL_SOCKET
||
407 cmsg
->cmsg_type
!= SCM_RIGHTS
) {
411 fd_size
= cmsg
->cmsg_len
- CMSG_LEN(0);
417 gotfds
= fd_size
/ sizeof(int);
418 *fds
= g_renew(int, *fds
, *nfds
+ gotfds
);
419 memcpy(*fds
+ *nfds
, CMSG_DATA(cmsg
), fd_size
);
421 for (i
= 0; i
< gotfds
; i
++) {
422 int fd
= (*fds
)[*nfds
+ i
];
427 /* O_NONBLOCK is preserved across SCM_RIGHTS so reset it */
430 #ifndef MSG_CMSG_CLOEXEC
431 qemu_set_cloexec(fd
);
439 static ssize_t
qio_channel_socket_readv(QIOChannel
*ioc
,
440 const struct iovec
*iov
,
446 QIOChannelSocket
*sioc
= QIO_CHANNEL_SOCKET(ioc
);
448 struct msghdr msg
= { NULL
, };
449 char control
[CMSG_SPACE(sizeof(int) * SOCKET_MAX_FDS
)];
452 #ifdef MSG_CMSG_CLOEXEC
453 sflags
|= MSG_CMSG_CLOEXEC
;
456 msg
.msg_iov
= (struct iovec
*)iov
;
457 msg
.msg_iovlen
= niov
;
459 msg
.msg_control
= control
;
460 msg
.msg_controllen
= sizeof(control
);
464 ret
= recvmsg(sioc
->fd
, &msg
, sflags
);
466 if (socket_error() == EAGAIN
||
467 socket_error() == EWOULDBLOCK
) {
468 return QIO_CHANNEL_ERR_BLOCK
;
470 if (socket_error() == EINTR
) {
474 error_setg_errno(errp
, socket_error(),
475 "Unable to read from socket");
480 qio_channel_socket_copy_fds(&msg
, fds
, nfds
);
486 static ssize_t
qio_channel_socket_writev(QIOChannel
*ioc
,
487 const struct iovec
*iov
,
493 QIOChannelSocket
*sioc
= QIO_CHANNEL_SOCKET(ioc
);
495 struct msghdr msg
= { NULL
, };
496 char control
[CMSG_SPACE(sizeof(int) * SOCKET_MAX_FDS
)] = { 0 };
497 size_t fdsize
= sizeof(int) * nfds
;
498 struct cmsghdr
*cmsg
;
500 msg
.msg_iov
= (struct iovec
*)iov
;
501 msg
.msg_iovlen
= niov
;
504 if (nfds
> SOCKET_MAX_FDS
) {
505 error_setg_errno(errp
, -EINVAL
,
506 "Only %d FDs can be sent, got %zu",
507 SOCKET_MAX_FDS
, nfds
);
511 msg
.msg_control
= control
;
512 msg
.msg_controllen
= CMSG_SPACE(sizeof(int) * nfds
);
514 cmsg
= CMSG_FIRSTHDR(&msg
);
515 cmsg
->cmsg_len
= CMSG_LEN(fdsize
);
516 cmsg
->cmsg_level
= SOL_SOCKET
;
517 cmsg
->cmsg_type
= SCM_RIGHTS
;
518 memcpy(CMSG_DATA(cmsg
), fds
, fdsize
);
522 ret
= sendmsg(sioc
->fd
, &msg
, 0);
524 if (socket_error() == EAGAIN
||
525 socket_error() == EWOULDBLOCK
) {
526 return QIO_CHANNEL_ERR_BLOCK
;
528 if (socket_error() == EINTR
) {
531 error_setg_errno(errp
, socket_error(),
532 "Unable to write to socket");
538 static ssize_t
qio_channel_socket_readv(QIOChannel
*ioc
,
539 const struct iovec
*iov
,
545 QIOChannelSocket
*sioc
= QIO_CHANNEL_SOCKET(ioc
);
549 for (i
= 0; i
< niov
; i
++) {
557 if (socket_error() == EAGAIN
) {
561 return QIO_CHANNEL_ERR_BLOCK
;
563 } else if (socket_error() == EINTR
) {
566 error_setg_errno(errp
, socket_error(),
567 "Unable to write to socket");
572 if (ret
< iov
[i
].iov_len
) {
580 static ssize_t
qio_channel_socket_writev(QIOChannel
*ioc
,
581 const struct iovec
*iov
,
587 QIOChannelSocket
*sioc
= QIO_CHANNEL_SOCKET(ioc
);
591 for (i
= 0; i
< niov
; i
++) {
599 if (socket_error() == EAGAIN
) {
603 return QIO_CHANNEL_ERR_BLOCK
;
605 } else if (socket_error() == EINTR
) {
608 error_setg_errno(errp
, socket_error(),
609 "Unable to write to socket");
614 if (ret
< iov
[i
].iov_len
) {
624 qio_channel_socket_set_blocking(QIOChannel
*ioc
,
628 QIOChannelSocket
*sioc
= QIO_CHANNEL_SOCKET(ioc
);
631 qemu_set_block(sioc
->fd
);
633 qemu_set_nonblock(sioc
->fd
);
640 qio_channel_socket_set_delay(QIOChannel
*ioc
,
643 QIOChannelSocket
*sioc
= QIO_CHANNEL_SOCKET(ioc
);
644 int v
= enabled
? 0 : 1;
646 qemu_setsockopt(sioc
->fd
,
647 IPPROTO_TCP
, TCP_NODELAY
,
653 qio_channel_socket_set_cork(QIOChannel
*ioc
,
656 QIOChannelSocket
*sioc
= QIO_CHANNEL_SOCKET(ioc
);
657 int v
= enabled
? 1 : 0;
659 socket_set_cork(sioc
->fd
, v
);
664 qio_channel_socket_close(QIOChannel
*ioc
,
667 QIOChannelSocket
*sioc
= QIO_CHANNEL_SOCKET(ioc
);
669 if (closesocket(sioc
->fd
) < 0) {
671 error_setg_errno(errp
, socket_error(),
672 "Unable to close socket");
680 qio_channel_socket_shutdown(QIOChannel
*ioc
,
681 QIOChannelShutdown how
,
684 QIOChannelSocket
*sioc
= QIO_CHANNEL_SOCKET(ioc
);
688 case QIO_CHANNEL_SHUTDOWN_READ
:
691 case QIO_CHANNEL_SHUTDOWN_WRITE
:
694 case QIO_CHANNEL_SHUTDOWN_BOTH
:
700 if (shutdown(sioc
->fd
, sockhow
) < 0) {
701 error_setg_errno(errp
, socket_error(),
702 "Unable to shutdown socket");
708 static GSource
*qio_channel_socket_create_watch(QIOChannel
*ioc
,
709 GIOCondition condition
)
711 QIOChannelSocket
*sioc
= QIO_CHANNEL_SOCKET(ioc
);
712 return qio_channel_create_fd_watch(ioc
,
717 static void qio_channel_socket_class_init(ObjectClass
*klass
,
718 void *class_data G_GNUC_UNUSED
)
720 QIOChannelClass
*ioc_klass
= QIO_CHANNEL_CLASS(klass
);
722 ioc_klass
->io_writev
= qio_channel_socket_writev
;
723 ioc_klass
->io_readv
= qio_channel_socket_readv
;
724 ioc_klass
->io_set_blocking
= qio_channel_socket_set_blocking
;
725 ioc_klass
->io_close
= qio_channel_socket_close
;
726 ioc_klass
->io_shutdown
= qio_channel_socket_shutdown
;
727 ioc_klass
->io_set_cork
= qio_channel_socket_set_cork
;
728 ioc_klass
->io_set_delay
= qio_channel_socket_set_delay
;
729 ioc_klass
->io_create_watch
= qio_channel_socket_create_watch
;
732 static const TypeInfo qio_channel_socket_info
= {
733 .parent
= TYPE_QIO_CHANNEL
,
734 .name
= TYPE_QIO_CHANNEL_SOCKET
,
735 .instance_size
= sizeof(QIOChannelSocket
),
736 .instance_init
= qio_channel_socket_init
,
737 .instance_finalize
= qio_channel_socket_finalize
,
738 .class_init
= qio_channel_socket_class_init
,
741 static void qio_channel_socket_register_types(void)
743 type_register_static(&qio_channel_socket_info
);
746 type_init(qio_channel_socket_register_types
);