+++ /dev/null
-/*
- * Copyright (C) 2012 David Goulet <dgoulet@efficios.com>
- *
- * SPDX-License-Identifier: GPL-2.0-only
- *
- */
-
-#define _LGPL_SOURCE
-#include <limits.h>
-#include <stdio.h>
-#include <stdlib.h>
-#include <string.h>
-#include <sys/stat.h>
-#include <sys/types.h>
-#include <unistd.h>
-#include <fcntl.h>
-#include <common/compat/time.h>
-#include <poll.h>
-
-#include <common/common.h>
-#include <common/time.h>
-#include <common/compat/errno.h>
-
-#include "inet6.h"
-
-#define RECONNECT_DELAY 200 /* ms */
-
-/*
- * INET protocol operations.
- */
-static const struct lttcomm_proto_ops inet6_ops = {
- .bind = lttcomm_bind_inet6_sock,
- .close = lttcomm_close_inet6_sock,
- .connect = lttcomm_connect_inet6_sock,
- .accept = lttcomm_accept_inet6_sock,
- .listen = lttcomm_listen_inet6_sock,
- .recvmsg = lttcomm_recvmsg_inet6_sock,
- .sendmsg = lttcomm_sendmsg_inet6_sock,
-};
-
-/*
- * Creates an PF_INET socket.
- */
-int lttcomm_create_inet6_sock(struct lttcomm_sock *sock, int type, int proto)
-{
- int val = 1, ret;
- unsigned long timeout;
-
- /* Create server socket */
- if ((sock->fd = socket(PF_INET6, type, proto)) < 0) {
- PERROR("socket inet6");
- goto error;
- }
-
- sock->ops = &inet6_ops;
-
- /*
- * Set socket option to reuse the address.
- */
- ret = setsockopt(sock->fd, SOL_SOCKET, SO_REUSEADDR, &val, sizeof(int));
- if (ret < 0) {
- PERROR("setsockopt inet6");
- goto error;
- }
- timeout = lttcomm_get_network_timeout();
- if (timeout) {
- ret = lttcomm_setsockopt_rcv_timeout(sock->fd, timeout);
- if (ret) {
- goto error;
- }
- ret = lttcomm_setsockopt_snd_timeout(sock->fd, timeout);
- if (ret) {
- goto error;
- }
- }
-
- return 0;
-
-error:
- return -1;
-}
-
-/*
- * Bind socket and return.
- */
-int lttcomm_bind_inet6_sock(struct lttcomm_sock *sock)
-{
- struct sockaddr_in6 sockaddr = sock->sockaddr.addr.sin6;
- return bind(sock->fd, &sockaddr, sizeof(sockaddr));
-}
-
-static
-int connect_no_timeout(struct lttcomm_sock *sock)
-{
- struct sockaddr_in6 sockaddr = sock->sockaddr.addr.sin6;
- return connect(sock->fd, &sockaddr, sizeof(sockaddr));
-}
-
-static
-int connect_with_timeout(struct lttcomm_sock *sock)
-{
- unsigned long timeout = lttcomm_get_network_timeout();
- int ret, flags, connect_ret;
- struct timespec orig_time, cur_time;
- unsigned long diff_ms;
- struct sockaddr_in6 sockaddr;
-
- ret = fcntl(sock->fd, F_GETFL, 0);
- if (ret == -1) {
- PERROR("fcntl");
- return -1;
- }
- flags = ret;
-
- /* Set socket to nonblock */
- ret = fcntl(sock->fd, F_SETFL, flags | O_NONBLOCK);
- if (ret == -1) {
- PERROR("fcntl");
- return -1;
- }
-
- ret = lttng_clock_gettime(CLOCK_MONOTONIC, &orig_time);
- if (ret == -1) {
- PERROR("clock_gettime");
- return -1;
- }
-
- sockaddr = sock->sockaddr.addr.sin6;
- connect_ret = connect(sock->fd, &sockaddr, sizeof(sockaddr));
- if (connect_ret == -1 && errno != EAGAIN && errno != EWOULDBLOCK &&
- errno != EINPROGRESS) {
- goto error;
- } else if (!connect_ret) {
- /* Connect succeeded */
- goto success;
- }
-
- DBG("Asynchronous connect for sock %d, performing polling with"
- " timeout: %lums", sock->fd, timeout);
-
- /*
- * Perform poll loop following EINPROGRESS recommendation from
- * connect(2) man page.
- */
- do {
- struct pollfd fds;
-
- fds.fd = sock->fd;
- fds.events = POLLOUT;
- fds.revents = 0;
- ret = poll(&fds, 1, RECONNECT_DELAY);
- if (ret < 0) {
- goto error;
- } else if (ret > 0) {
- int optval;
- socklen_t optval_len = sizeof(optval);
-
- if (!(fds.revents & POLLOUT)) {
- /* Either hup or error */
- errno = EPIPE;
- goto error;
- }
- /* got something */
- ret = getsockopt(sock->fd, SOL_SOCKET,
- SO_ERROR, &optval, &optval_len);
- if (ret) {
- PERROR("getsockopt");
- goto error;
- }
- if (!optval) {
- connect_ret = 0;
- goto success;
- } else {
- /* Get actual connect() errno from opt_val */
- errno = optval;
- goto error;
- }
- }
- /* ret == 0: timeout */
- ret = lttng_clock_gettime(CLOCK_MONOTONIC, &cur_time);
- if (ret == -1) {
- PERROR("clock_gettime");
- connect_ret = ret;
- goto error;
- }
- if (timespec_to_ms(timespec_abs_diff(cur_time, orig_time), &diff_ms) < 0) {
- ERR("timespec_to_ms input overflows milliseconds output");
- connect_ret = -1;
- goto error;
- }
- } while (diff_ms < timeout);
-
- /* Timeout */
- errno = ETIMEDOUT;
- connect_ret = -1;
-
-success:
- /* Restore initial flags */
- ret = fcntl(sock->fd, F_SETFL, flags);
- if (ret == -1) {
- PERROR("fcntl");
- /* Continue anyway */
- }
-error:
- return connect_ret;
-}
-
-/*
- * Connect PF_INET socket.
- */
-int lttcomm_connect_inet6_sock(struct lttcomm_sock *sock)
-{
- int ret, closeret;
-
- if (lttcomm_get_network_timeout()) {
- ret = connect_with_timeout(sock);
- } else {
- ret = connect_no_timeout(sock);
- }
- if (ret < 0) {
- PERROR("connect inet6");
- goto error_connect;
- }
-
- return ret;
-
-error_connect:
- closeret = close(sock->fd);
- if (closeret) {
- PERROR("close inet6");
- }
-
- return ret;
-}
-
-/*
- * Do an accept(2) on the sock and return the new lttcomm socket. The socket
- * MUST be bind(2) before.
- */
-struct lttcomm_sock *lttcomm_accept_inet6_sock(struct lttcomm_sock *sock)
-{
- int new_fd;
- socklen_t len;
- struct lttcomm_sock *new_sock;
- struct sockaddr_in6 new_addr = {};
-
- if (sock->proto == LTTCOMM_SOCK_UDP) {
- /*
- * accept(2) does not exist for UDP so simply return the passed socket.
- */
- new_sock = sock;
- goto end;
- }
-
- new_sock = lttcomm_alloc_sock(sock->proto);
- if (new_sock == NULL) {
- goto error;
- }
-
- len = sizeof(new_addr);
-
- /* Blocking call */
- new_fd = accept(sock->fd, (struct sockaddr *) &new_addr, &len);
- if (new_fd < 0) {
- PERROR("accept inet6");
- goto error;
- }
- new_sock->sockaddr.addr.sin6 = new_addr;
- new_sock->fd = new_fd;
- new_sock->ops = &inet6_ops;
-
-end:
- return new_sock;
-
-error:
- free(new_sock);
- return NULL;
-}
-
-/*
- * Make the socket listen using LTTNG_SESSIOND_COMM_MAX_LISTEN.
- */
-int lttcomm_listen_inet6_sock(struct lttcomm_sock *sock, int backlog)
-{
- int ret;
-
- if (sock->proto == LTTCOMM_SOCK_UDP) {
- /* listen(2) does not exist for UDP so simply return success. */
- ret = 0;
- goto end;
- }
-
- /* Default listen backlog */
- if (backlog <= 0) {
- backlog = LTTNG_SESSIOND_COMM_MAX_LISTEN;
- }
-
- ret = listen(sock->fd, backlog);
- if (ret < 0) {
- PERROR("listen inet6");
- }
-
-end:
- return ret;
-}
-
-/*
- * Receive data of size len in put that data into the buf param. Using recvmsg
- * API.
- *
- * Return the size of received data.
- */
-ssize_t lttcomm_recvmsg_inet6_sock(struct lttcomm_sock *sock, void *buf,
- size_t len, int flags)
-{
- struct msghdr msg;
- struct iovec iov[1];
- ssize_t ret = -1;
- size_t len_last;
- struct sockaddr_in6 addr = sock->sockaddr.addr.sin6;
-
- memset(&msg, 0, sizeof(msg));
-
- iov[0].iov_base = buf;
- iov[0].iov_len = len;
- msg.msg_iov = iov;
- msg.msg_iovlen = 1;
-
- msg.msg_name = (struct sockaddr *) &addr;
- msg.msg_namelen = sizeof(sock->sockaddr.addr.sin6);
-
- do {
- len_last = iov[0].iov_len;
- ret = recvmsg(sock->fd, &msg, flags);
- if (ret > 0) {
- if (flags & MSG_DONTWAIT) {
- goto end;
- }
- iov[0].iov_base += ret;
- iov[0].iov_len -= ret;
- LTTNG_ASSERT(ret <= len_last);
- }
- } while ((ret > 0 && ret < len_last) || (ret < 0 && errno == EINTR));
- if (ret < 0) {
- PERROR("recvmsg inet");
- } else if (ret > 0) {
- ret = len;
- }
- /* Else ret = 0 meaning an orderly shutdown. */
-end:
- return ret;
-}
-
-/*
- * Send buf data of size len. Using sendmsg API.
- *
- * Return the size of sent data.
- */
-ssize_t lttcomm_sendmsg_inet6_sock(struct lttcomm_sock *sock, const void *buf,
- size_t len, int flags)
-{
- struct msghdr msg;
- struct iovec iov[1];
- ssize_t ret = -1;
-
- memset(&msg, 0, sizeof(msg));
-
- iov[0].iov_base = (void *) buf;
- iov[0].iov_len = len;
- msg.msg_iov = iov;
- msg.msg_iovlen = 1;
-
- switch (sock->proto) {
- case LTTCOMM_SOCK_UDP:
- {
- struct sockaddr_in6 addr = sock->sockaddr.addr.sin6;
-
- msg.msg_name = (struct sockaddr *) &addr;
- msg.msg_namelen = sizeof(sock->sockaddr.addr.sin6);
- break;
- }
- default:
- break;
- }
-
- do {
- ret = sendmsg(sock->fd, &msg, flags);
- } while (ret < 0 && errno == EINTR);
- if (ret < 0) {
- /*
- * Only warn about EPIPE when quiet mode is deactivated.
- * We consider EPIPE as expected.
- */
- if (errno != EPIPE || !lttng_opt_quiet) {
- PERROR("sendmsg inet6");
- }
- }
-
- return ret;
-}
-
-/*
- * Shutdown cleanly and close.
- */
-int lttcomm_close_inet6_sock(struct lttcomm_sock *sock)
-{
- int ret;
-
- /* Don't try to close an invalid marked socket */
- if (sock->fd == -1) {
- return 0;
- }
-
- ret = close(sock->fd);
- if (ret) {
- PERROR("close inet6");
- }
-
- /* Mark socket */
- sock->fd = -1;
-
- return ret;
-}