net.c: Cosmetics.

[paraslash.git] / net.c

/*
 * Copyright (C) 2005-2007 Andre Noll <maan@systemlinux.org>
 *
 * Licensed under the GPL v2. For licencing details see COPYING.
 */

/** \file net.c Networking-related helper functions. */

#include "para.h"
#include "error.h"
#include "net.h"
#include "string.h"


/** Information about one encrypted connection. */
struct crypt_data {
        /** Function used to decrypt received data. */
        crypt_function *recv;
        /** Function used to encrypt data to be sent. */
        crypt_function *send;
        /**
         * Context-dependent data (crypt keys), passed verbatim to the above
         * crypt functions.
         */
        void *private_data;
};
/** Array holding per fd crypt data. */
static struct crypt_data *crypt_data_array;
/** Current size of the crypt data array. */
static unsigned cda_size = 0;

/**
 * Activate encryption for one file descriptor.
 *
 * \param fd The file descriptor.
 * \param recv_f The function used for decrypting received data.
 * \param send_f The function used for encrypting before sending.
 * \param private_data User data supplied by the caller.
 */
void enable_crypt(int fd, crypt_function *recv_f, crypt_function *send_f,
        void *private_data)
{
        if (fd + 1 > cda_size) {
                crypt_data_array = para_realloc(crypt_data_array,
                        (fd + 1) * sizeof(struct crypt_data));
                memset(crypt_data_array + cda_size, 0,
                        (fd + 1 - cda_size) * sizeof(struct crypt_data));
                cda_size = fd + 1;
        }
        crypt_data_array[fd].recv = recv_f;
        crypt_data_array[fd].send = send_f;
        crypt_data_array[fd].private_data = private_data;
        PARA_INFO_LOG("rc4 encryption activated for fd %d\n", fd);
}

/**
 * Deactivate encryption for a given fd.
 *
 * \param fd The file descriptor.
 *
 * This must be called if and only if \p fd was activated via enable_crypt().
 */
void disable_crypt(int fd)
{
        if (cda_size < fd + 1)
                return;
        crypt_data_array[fd].recv = NULL;
        crypt_data_array[fd].send = NULL;
        crypt_data_array[fd].private_data = NULL;
}


/**
 * Initialize a struct sockaddr_in.
 *
 * \param addr A pointer to the struct to be initialized.
 * \param port The port number to use.
 * \param he The address to use.
 *
 * If \a he is null (server mode), \a addr->sin_addr is initialized with \p
 * INADDR_ANY.  Otherwise, the address given by \a he is copied to addr.
 */
void init_sockaddr(struct sockaddr_in *addr, int port, const struct hostent *he)
{
        /* host byte order */
        addr->sin_family = AF_INET;
        /* short, network byte order */
        addr->sin_port = htons(port);
        if (he)
                addr->sin_addr = *((struct in_addr *)he->h_addr);
        else
                addr->sin_addr.s_addr = INADDR_ANY;
        /* zero the rest of the struct */
        memset(&addr->sin_zero, '\0', 8);
}

/*
 * Send out a buffer, resend on short writes.
 *
 * \param fd The file descriptor.
 * \param buf The buffer to be sent.
 * \param len The length of \a buf.
 *
 * \return Standard. In any case, the number of bytes actually sent is stored
 * in \a len.
 */
static int sendall(int fd, const char *buf, size_t *len)
{
        size_t total = *len;

        assert(total);
        *len = 0;
        while (*len < total) {
                int ret = send(fd, buf + *len, total - *len, 0);
                if (ret == -1)
                        return -ERRNO_TO_PARA_ERROR(errno);
                *len += ret;
        }
        return 1;
}

/**
 * Encrypt and send a binary buffer.
 *
 * \param fd The file descriptor.
 * \param buf The buffer to be encrypted and sent.
 * \param len The length of \a buf.
 *
 * Check if encryption is available. If yes, encrypt the given buffer.  Send
 * out the buffer, encrypted or not, and try to resend the remaing part in case
 * of short writes.
 *
 * \return Standard.
 */
int send_bin_buffer(int fd, const char *buf, size_t len)
{
        int ret;
        crypt_function *cf = NULL;

        if (!len)
                PARA_CRIT_LOG("%s", "len == 0\n");
        if (fd + 1 <= cda_size)
                cf = crypt_data_array[fd].send;
        if (cf) {
                void *private = crypt_data_array[fd].private_data;
                /* RC4 may write more than len to the output buffer */
                unsigned char *outbuf = para_malloc(ROUND_UP(len, 8));
                (*cf)(len, (unsigned char *)buf, outbuf, private);
                ret = sendall(fd, (char *)outbuf, &len);
                free(outbuf);
        } else
                ret = sendall(fd, buf, &len);
        return ret;
}

/**
 * Encrypt and send null terminated buffer.
 *
 * \param fd The file descriptor.
 * \param buf The null-terminated buffer to be send.
 *
 * This is equivalent to send_bin_buffer(fd, buf, strlen(buf)).
 *
 * \return Standard.
 */
int send_buffer(int fd, const char *buf)
{
        return send_bin_buffer(fd, buf, strlen(buf));
}


/**
 * Send and encrypt a buffer given by a format string.
 *
 * \param fd The file descriptor.
 * \param fmt A format string.
 *
 * \return Standard.
 */
__printf_2_3 int send_va_buffer(int fd, const char *fmt, ...)
{
        char *msg;
        int ret;

        PARA_VSPRINTF(fmt, msg);
        ret = send_buffer(fd, msg);
        free(msg);
        return ret;
}

/**
 * Receive and decrypt.
 *
 * \param fd The file descriptor.
 * \param buf The buffer to write the decrypted data to.
 * \param size The size of \a buf.
 *
 * Receive at most \a size bytes from file descriptor \a fd. If encryption is
 * available, decrypt the received buffer.
 *
 * \return The number of bytes received on success, negative on errors.
 *
 * \sa recv(2)
 */
__must_check int recv_bin_buffer(int fd, char *buf, size_t size)
{
        ssize_t n;
        crypt_function *cf = NULL;

        if (fd + 1 <= cda_size)
                cf = crypt_data_array[fd].recv;
        if (cf) {
                unsigned char *tmp = para_malloc(size);
                void *private = crypt_data_array[fd].private_data;
                n = recv(fd, tmp, size, 0);
                if (n > 0) {
                        size_t numbytes = n;
                        unsigned char *b = (unsigned char *)buf;
                        (*cf)(numbytes, tmp, b, private);
                }
                free(tmp);
        } else
                n = recv(fd, buf, size, 0);
        if (n == -1)
                return -ERRNO_TO_PARA_ERROR(errno);
        return n;
}

/**
 * Receive, decrypt and write terminating NULL byte.
 *
 * \param fd The file descriptor.
 * \param buf The buffer to write the decrypted data to.
 * \param size The size of \a buf.
 *
 * Read and decrypt at most \a size - 1 bytes from file descriptor \a fd and
 * write a NULL byte at the end of the received data.
 *
 * \return The return value of the underlying call to \a recv_bin_buffer().
 *
 * \sa recv_bin_buffer()
 */
int recv_buffer(int fd, char *buf, size_t size)
{
        int n;

        assert(size);
        n = recv_bin_buffer(fd, buf, size - 1);
        if (n >= 0)
                buf[n] = '\0';
        else
                *buf = '\0';
        return n;
}

/**
 * wrapper around gethostbyname
 *
 * \param host hostname or IPv4 address
 * \param ret the hostent structure is returned here
 *
 * \return positive on success, negative on errors. On success, \a ret
 * contains the return value of the underlying gethostbyname() call.
 *
 * \sa gethostbyname(2)
 */
int get_host_info(char *host, struct hostent **ret)
{
        PARA_INFO_LOG("getting host info of %s\n", host);
        /* FIXME: gethostbyname() is obsolete */
        *ret = gethostbyname(host);
        return *ret? 1 : -E_HOST_INFO;
}

/**
 * A wrapper around socket(2).
 *
 * \param domain The communication domain that selects the protocol family.
 *
 * \return The socket fd on success, -E_SOCKET on errors.
 *
 * Create an IPv4 socket for sequenced, reliable, two-way, connection-based
 * byte streams.
 *
 * \sa socket(2).
 */
int get_stream_socket(int domain)
{
        int socket_fd;

        if ((socket_fd = socket(domain, SOCK_STREAM, 0)) == -1)
                return -E_SOCKET;
        return socket_fd;
}

/**
 * Wrapper around the accept system call.
 *
 * \param fd The listening socket.
 * \param addr Structure which is filled in with the address of the peer socket.
 * \param size Should contain the size of the structure pointed to by \a addr.
 *
 * Accept incoming connections on \a addr. Retry if interrupted.
 *
 * \return The new file descriptor on success, negative on errors.
 *
 * \sa accept(2).
 */
int para_accept(int fd, void *addr, socklen_t size)
{
        int new_fd;

        do
                new_fd = accept(fd, (struct sockaddr *) addr, &size);
        while (new_fd < 0 && errno == EINTR);
        return new_fd < 0? -ERRNO_TO_PARA_ERROR(errno) : new_fd;
}

static int setserversockopts(int socket_fd)
{
        int yes = 1;

        if (setsockopt(socket_fd, SOL_SOCKET, SO_REUSEADDR, &yes,
                        sizeof(int)) == -1)
                return -E_SETSOCKOPT;
        return 1;
}

/**
 * prepare a structure for \p AF_UNIX socket addresses
 *
 * \param u pointer to the struct to be prepared
 * \param name the socket pathname
 *
 * This just copies \a name to the sun_path component of \a u.
 *
 * \return Positive on success, \p -E_NAME_TOO_LONG if \a name is longer
 * than \p UNIX_PATH_MAX.
 */
int init_unix_addr(struct sockaddr_un *u, const char *name)
{
        if (strlen(name) >= UNIX_PATH_MAX)
                return -E_NAME_TOO_LONG;
        memset(u->sun_path, 0, UNIX_PATH_MAX);
        u->sun_family = PF_UNIX;
        strcpy(u->sun_path, name);
        return 1;
}

/**
 * Prepare, create, and bind a socket for local communication.
 *
 * \param name The socket pathname.
 * \param unix_addr Pointer to the \p AF_UNIX socket structure.
 * \param mode The desired mode of the socket.
 *
 * This functions creates a local socket for sequenced, reliable,
 * two-way, connection-based byte streams.
 *
 * \return The file descriptor, on success, negative on errors.
 *
 * \sa socket(2)
 * \sa bind(2)
 * \sa chmod(2)
 */
int create_local_socket(const char *name, struct sockaddr_un *unix_addr,
                mode_t mode)
{
        int fd, ret;

        ret = init_unix_addr(unix_addr, name);
        if (ret < 0)
                return ret;
        fd = socket(PF_UNIX, SOCK_STREAM, 0);
        if (fd < 0)
                return -E_SOCKET;
        ret = -E_BIND;
        if (bind(fd, (struct sockaddr *) unix_addr, UNIX_PATH_MAX) < 0)
                goto err;
        ret = -E_CHMOD;
        if (chmod(name, mode) < 0)
                goto err;
        return fd;
err:
        close(fd);
        return ret;
}

#ifndef HAVE_UCRED
ssize_t send_cred_buffer(int sock, char *buf)
{
        return send_buffer(sock, buf);
}
int recv_cred_buffer(int fd, char *buf, size_t size)
{
        return recv_buffer(fd, buf, size) > 0? 1 : -E_RECVMSG;
}
#else /* HAVE_UCRED */
/**
 * send NULL terminated buffer and Unix credentials of the current process
 *
 * \param sock the socket file descriptor
 * \param buf the buffer to be sent
 *
 * \return On success, this call returns the number of characters sent.  On
 * error, \p -E_SENDMSG is returned.
 *
 * \sa  okir's Black Hats Manual
 * \sa sendmsg(2)
 */
ssize_t send_cred_buffer(int sock, char *buf)
{
        char control[sizeof(struct cmsghdr) + 10];
        struct msghdr msg;
        struct cmsghdr *cmsg;
        static struct iovec iov;
        struct ucred c;
        int ret;

        /* Response data */
        iov.iov_base = buf;
        iov.iov_len  = strlen(buf);
        c.pid = getpid();
        c.uid = getuid();
        c.gid = getgid();
        /* compose the message */
        memset(&msg, 0, sizeof(msg));
        msg.msg_iov = &iov;
        msg.msg_iovlen = 1;
        msg.msg_control = control;
        msg.msg_controllen = sizeof(control);
        /* attach the ucred struct */
        cmsg = CMSG_FIRSTHDR(&msg);
        cmsg->cmsg_level = SOL_SOCKET;
        cmsg->cmsg_type = SCM_CREDENTIALS;
        cmsg->cmsg_len = CMSG_LEN(sizeof(struct ucred));
        *(struct ucred *)CMSG_DATA(cmsg) = c;
        msg.msg_controllen = cmsg->cmsg_len;
        ret = sendmsg(sock, &msg, 0);
        if (ret  < 0)
                ret = -E_SENDMSG;
        return ret;
}

static void dispose_fds(int *fds, unsigned num)
{
        int i;

        for (i = 0; i < num; i++)
                close(fds[i]);
}

/**
 * receive a buffer and the Unix credentials of the sending process
 *
 * \param fd the socket file descriptor
 * \param buf the buffer to store the message
 * \param size the size of \a buffer
 *
 * \return negative on errors, the user id on success.
 *
 * \sa okir's Black Hats Manual
 * \sa recvmsg(2)
 */
int recv_cred_buffer(int fd, char *buf, size_t size)
{
        char control[255];
        struct msghdr msg;
        struct cmsghdr *cmsg;
        struct iovec iov;
        int result = 0;
        int yes = 1;
        struct ucred cred;

        setsockopt(fd, SOL_SOCKET, SO_PASSCRED, &yes, sizeof(int));
        memset(&msg, 0, sizeof(msg));
        memset(buf, 0, size);
        iov.iov_base = buf;
        iov.iov_len = size;
        msg.msg_iov = &iov;
        msg.msg_iovlen = 1;
        msg.msg_control = control;
        msg.msg_controllen = sizeof(control);
        if (recvmsg(fd, &msg, 0) < 0)
                return -E_RECVMSG;
        result = -E_SCM_CREDENTIALS;
        cmsg = CMSG_FIRSTHDR(&msg);
        while (cmsg) {
                if (cmsg->cmsg_level == SOL_SOCKET && cmsg->cmsg_type
                                == SCM_CREDENTIALS) {
                        memcpy(&cred, CMSG_DATA(cmsg), sizeof(struct ucred));
                        result = cred.uid;
                } else
                        if (cmsg->cmsg_level == SOL_SOCKET
                                        && cmsg->cmsg_type == SCM_RIGHTS) {
                                dispose_fds((int *) CMSG_DATA(cmsg),
                                        (cmsg->cmsg_len - CMSG_LEN(0))
                                        / sizeof(int));
                        }
                cmsg = CMSG_NXTHDR(&msg, cmsg);
        }
        return result;
}
#endif /* HAVE_UCRED */

/** how many pending connections queue will hold */
#define BACKLOG 10

/**
 * create a socket, bind it and listen
 *
 * \param port the tcp port to listen on
 *
 * \return The file descriptor of the created socket, negative
 * on errors.
 *
 * \sa get_stream_socket()
 * \sa setsockopt(2)
 * \sa bind(2)
 * \sa listen(2)
 */
int init_tcp_socket(int port)
{
        struct sockaddr_in my_addr;
        int fd, ret = get_stream_socket(AF_INET);

        if (ret < 0)
                return ret;
        fd = ret;
        ret = setserversockopts(fd);
        if (ret < 0)
                goto err;
        init_sockaddr(&my_addr, port, NULL);
        ret = -E_BIND;
        if (bind(fd, (struct sockaddr *)&my_addr,
                        sizeof(struct sockaddr)) == -1) {
                PARA_CRIT_LOG("bind error: %s\n", strerror(errno));
                goto err;
        }
        ret = -E_LISTEN;
        if (listen(fd, BACKLOG) == -1)
                goto err;
        PARA_INFO_LOG("listening on port %d, fd %d\n", port, fd);
        return fd;
err:
        close(fd);
        return ret;
}

/**
 * receive a buffer and check for a pattern
 *
 * \param fd the file descriptor to receive from
 * \param pattern the expected pattern
 * \param bufsize the size of the internal buffer
 *
 * \return Positive if \a pattern was received, negative otherwise.
 *
 * This function creates a buffer of size \a bufsize and tries
 * to receive at most \a bufsize bytes from file descriptor \a fd.
 * If at least \p strlen(\a pattern) bytes were received, the beginning of
 * the received buffer is compared with \a pattern, ignoring case.
 *
 * \sa recv_buffer()
 * \sa strncasecmp(3)
 */
int recv_pattern(int fd, const char *pattern, size_t bufsize)
{
        size_t len = strlen(pattern);
        char *buf = para_malloc(bufsize + 1);
        int ret = -E_RECV_PATTERN, n = recv_buffer(fd, buf, bufsize);

        if (n < len)
                goto out;
        if (strncasecmp(buf, pattern, len))
                goto out;
        ret = 1;
out:
        if (ret < 0) {
                PARA_NOTICE_LOG("n = %d, did not receive pattern '%s'\n", n, pattern);
                if (n > 0)
                        PARA_NOTICE_LOG("recvd: %s\n", buf);
        }
        free(buf);
        return ret;
}