Laika/lib/src/lsocket.c

#include <alloca.h>

#include "lerror.h"
#include "lmem.h"
#include "lpolllist.h"
#include "lsocket.h"

static int _LNSetup = 0;

bool laikaS_isBigEndian(void) {
    union {
        uint32_t i;
        uint8_t c[4];
    } _indxint = {0xDEADB33F};

    return _indxint.c[0] == 0xDE;
}

void laikaS_init(void) {
    if (_LNSetup++ > 0)
        return; /* WSA is already setup! */

#ifdef _WIN32
    WSADATA wsaData;

    if (WSAStartup(MAKEWORD(1, 1), &wsaData) != 0)
        LAIKA_ERROR("WSAStartup failed!\n")
#endif
}

void laikaS_cleanUp(void) {
    if (--_LNSetup > 0)
        return; /* WSA still needs to be up, a FoxNet peer is still using it */

#ifdef _WIN32
    WSACleanup();
#endif
}

void laikaS_initSocket(struct sLaika_socket *sock) {
    sock->sock = INVALID_SOCKET;
    sock->inBuf = NULL;
    sock->inCap = ARRAY_START;
    sock->inCount = 0;
    sock->outBuf = NULL;
    sock->outCap = ARRAY_START;
    sock->outCount = 0;
    sock->flipEndian = false;

    laikaS_init();
}

void laikaS_cleanSocket(struct sLaika_socket *sock) {
    /* free in & out arrays */
    laikaM_free(sock->inBuf);
    laikaM_free(sock->outBuf);

    /* kill socket & cleanup WSA */
    laikaS_kill(sock);
    laikaS_cleanUp();
}

void laikaS_kill(struct sLaika_socket *sock) {
    if (!laikaS_isAlive(sock)) /* sanity check */
        return;

#ifdef _WIN32
    shutdown(sock->sock, SD_BOTH);
    closesocket(sock->sock);
#else
    shutdown(sock->sock, SHUT_RDWR);
    close(sock->sock);
#endif

    sock->sock = INVALID_SOCKET;
}

void laikaS_connect(struct sLaika_socket *sock, char *ip, char *port) {
    struct addrinfo res, *result, *curr;

    if (!SOCKETINVALID(sock->sock))
        LAIKA_ERROR("socket already setup!\n");

    /* zero out our address info and setup the type */
    memset(&res, 0, sizeof(struct addrinfo));
    res.ai_family = AF_UNSPEC;
    res.ai_socktype = SOCK_STREAM;

    /* grab the address info */
    if (getaddrinfo(ip, port, &res, &result) != 0)
        LAIKA_ERROR("getaddrinfo() failed!\n");

    /* getaddrinfo returns a list of possible addresses, step through them and try them until we find a valid address */
    for (curr = result; curr != NULL; curr = curr->ai_next) {
        sock->sock = socket(curr->ai_family, curr->ai_socktype, curr->ai_protocol);

        /* if it failed, try the next sock */
        if (SOCKETINVALID(sock->sock))
            continue;
        
        /* if it's not an invalid socket, break and exit the loop, we found a working addr! */
        if (!SOCKETINVALID(connect(sock->sock, curr->ai_addr, curr->ai_addrlen)))
            break;

        laikaS_kill(sock);
    }
    freeaddrinfo(result);

    /* if we reached the end of the linked list, we failed looking up the addr */
    if (curr == NULL)
        LAIKA_ERROR("couldn't connect a valid address handle to socket!\n");
}

void laikaS_bind(struct sLaika_socket *sock, uint16_t port) {
    socklen_t addressSize;
    struct sockaddr_in address;

    if (!SOCKETINVALID(sock->sock))
        LAIKA_ERROR("socket already setup!\n")

    /* open our socket */
    sock->sock = socket(AF_INET, SOCK_STREAM, 0);
    if (SOCKETINVALID(sock->sock))
        LAIKA_ERROR("socket() failed!\n");

    /* attach socket to the port */
    int opt = 1;
#ifdef _WIN32
    if (setsockopt(sock->sock, SOL_SOCKET, SO_REUSEADDR, (const char*)&opt, sizeof(int)) != 0)
#else
    if (setsockopt(sock->sock, SOL_SOCKET, SO_REUSEADDR, &opt, sizeof(int)) != 0)
#endif
        LAIKA_ERROR("setsockopt() failed!\n");

    address.sin_family = AF_INET;
    address.sin_addr.s_addr = INADDR_ANY;
    address.sin_port = htons(port);

    addressSize = sizeof(struct sockaddr_in);

    /* bind to the port */
    if (SOCKETERROR(bind(sock->sock, (struct sockaddr *)&address, addressSize)))
        LAIKA_ERROR("bind() failed!\n");

    if (SOCKETERROR(listen(sock->sock, SOMAXCONN)))
        LAIKA_ERROR("listen() failed!\n");
}

void laikaS_acceptFrom(struct sLaika_socket *sock, struct sLaika_socket *from) {
    socklen_t addressSize;
    struct sockaddr address;

    sock->sock = accept(from->sock, &address, &addressSize);
    if (SOCKETINVALID(sock->sock))
        LAIKA_ERROR("accept() failed!\n")
}

bool laikaS_setNonBlock(struct sLaika_socket *sock) {
#ifdef _WIN32
    unsigned long mode = 1;
    if (ioctlsocket(sock->sock, FIONBIO, &mode) != 0) {
#else
    if (fcntl(sock->sock, F_SETFL, (fcntl(sock->sock, F_GETFL, 0) | O_NONBLOCK)) != 0) {
#endif
        LAIKA_WARN("fcntl failed on new connection\n");
        laikaS_kill(sock);
        return false;
    }

    return true;
}

void laikaS_read(struct sLaika_socket *sock, void *buf, size_t sz) {
    memcpy(buf, sock->inBuf, sz);
    laikaM_rmvarray(uint8_t, sock->inBuf, sock->inCount, 0, sz);
}

void laikaS_write(struct sLaika_socket *sock, void *buf, size_t sz) {
    /* make sure we have enough space to copy the buffer */
    laikaM_growarray(uint8_t, sock->outBuf, sock->outCount + sz, sock->outCap);\

    /* copy the buffer, then increment outCount */
    memcpy(&sock->outBuf[sock->outCount], buf, sz);
    sock->outCount += sz;
}

void laikaS_writeByte(struct sLaika_socket *sock, uint8_t data) {
    laikaM_growarray(uint8_t, sock->outBuf, sock->outCount, sock->outCap);
    sock->outBuf[sock->outCount++] = data;
}

uint8_t laikaS_readByte(struct sLaika_socket *sock) {
    uint8_t tmp = *sock->inBuf;

    /* pop 1 byte */
    laikaM_rmvarray(uint8_t, sock->inBuf, sock->inCount, 0, 1);
    return tmp;
}

void laikaS_readInt(struct sLaika_socket *sock, void *buf, size_t sz) {
    if (sock->flipEndian) {
        uint8_t tmp[sz]; /* allocate tmp buffer to hold data while we switch endianness */
        int k;

        laikaS_read(sock, (void*)tmp, sz);

        /* copy tmp buffer to user buffer, flipping endianness */
        for (k = 0; k < sz; k++)
            *(uint8_t*)(buf + k) = tmp[sz - k - 1];
    } else {
        /* just a wrapper for laikaS_read */
        laikaS_read(sock, buf, sz);
    }
}

void laikaS_writeInt(struct sLaika_socket *sock, void *buf, size_t sz) {
    if (sock->flipEndian) {
        uint8_t tmp[sz]; /* allocate tmp buffer to hold data while we switch endianness */
        int k;

        /* copy user buffer to tmp buffer, flipping endianness */
        for (k = 0; k < sz; k++)
            tmp[k] = *(uint8_t*)(buf + (sz - k - 1));

        laikaS_write(sock, (void*)tmp, sz);
    } else {
        /* just a wrapper for laikaS_write */
        laikaS_write(sock, buf, sz);
    }
}

RAWSOCKCODE laikaS_rawRecv(struct sLaika_socket *sock, size_t sz, int *processed) {
    RAWSOCKCODE errCode = RAWSOCK_OK;
    int rcvd, start = sock->inCount;

    /* make sure we have enough space to recv */
    laikaM_growarray(uint8_t, sock->inBuf, sock->inCount + sz, sock->inCap);
    rcvd = recv(sock->sock, (buffer_t*)&sock->inBuf[sock->inCount], sz, LN_MSG_NOSIGNAL);

    if (rcvd == 0) {
        errCode = RAWSOCK_CLOSED;
    } else if (SOCKETERROR(rcvd) && LN_ERRNO != LN_EWOULD
#ifndef _WIN32
        /* if it's a posix system, also make sure its not a EAGAIN result (which is a recoverable error, there's just nothing to read lol) */
        && LN_ERRNO != EAGAIN
#endif
    ) {
        /* if the socket closed or an error occurred, return the error result */
        errCode = RAWSOCK_ERROR;
    } else if (rcvd > 0) {
        /* recv() worked, add rcvd to inCount */
        sock->inCount += rcvd;
    }

    *processed = rcvd;
    return errCode;
}

RAWSOCKCODE laikaS_rawSend(struct sLaika_socket *sock, size_t sz, int *processed) {
    RAWSOCKCODE errCode = RAWSOCK_OK;
    int sent, sentBytes = 0;

    /* write bytes to the socket until an error occurs or we finish sending */
    do {
        sent = send(sock->sock, (buffer_t*)(&sock->outBuf[sentBytes]), sz - sentBytes, LN_MSG_NOSIGNAL);

        /* check for error result */
        if (sent == 0) { /* connection closed gracefully */
            errCode = RAWSOCK_CLOSED;
            goto _rawWriteExit;
        } else if (SOCKETERROR(sent)) { /* socket error? */
            if (LN_ERRNO != LN_EWOULD
#ifndef _WIN32
                /* posix also has some platforms which define EAGAIN as a different value than EWOULD, might as well support it. */
                && LN_ERRNO != EAGAIN
#endif
            ) { /* socket error! */
                errCode = RAWSOCK_ERROR;
                goto _rawWriteExit;
            }

            /*
                it was a result of EWOULD or EAGAIN, kernel socket send buffer is full,
                tell the caller we need to set our poll event POLLOUT
            */
            errCode = RAWSOCK_POLL;
            goto _rawWriteExit;
        }
    } while((sentBytes += sent) < sz);

_rawWriteExit:
    /* trim sent data from outBuf */
    laikaM_rmvarray(uint8_t, sock->outBuf, sock->outCount, 0, sentBytes);

    *processed = sentBytes;
    return errCode;
}