source: mainline/uspace/srv/net/udp/service.c@ eed4139

/*
 * Copyright (c) 2015 Jiri Svoboda
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

/** @addtogroup udp
 * @{
 */

/**
 * @file HelenOS service implementation
 */

#include <async.h>
#include <errno.h>
#include <inet/endpoint.h>
#include <io/log.h>
#include <ipc/services.h>
#include <ipc/udp.h>
#include <loc.h>
#include <macros.h>
#include <stdlib.h>

#include "assoc.h"
#include "msg.h"
#include "service.h"
#include "udp_type.h"

#define NAME "udp"

/** Maximum message size */
#define MAX_MSG_SIZE DATA_XFER_LIMIT

static void udp_cassoc_recv_msg(void *, inet_ep2_t *, udp_msg_t *);

/** Callbacks to tie us to association layer */
static udp_assoc_cb_t udp_cassoc_cb = {
        .recv_msg = udp_cassoc_recv_msg
};

/** Add message to client receive queue.
 *
 * @param cassoc Client association
 * @param epp    Endpoint pair on which message was received
 * @param msg    Message
 *
 * @return EOK on success, ENOMEM if out of memory
 */
static errno_t udp_cassoc_queue_msg(udp_cassoc_t *cassoc, inet_ep2_t *epp,
    udp_msg_t *msg)
{
        udp_crcv_queue_entry_t *rqe;

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_cassoc_queue_msg(%p, %p, %p)",
            cassoc, epp, msg);

        rqe = calloc(1, sizeof(udp_crcv_queue_entry_t));
        if (rqe == NULL)
                return ENOMEM;

        link_initialize(&rqe->link);
        rqe->epp = *epp;
        rqe->msg = msg;
        rqe->cassoc = cassoc;

//      fibril_mutex_lock(&assoc->lock);
        list_append(&rqe->link, &cassoc->client->crcv_queue);
//      fibril_mutex_unlock(&assoc->lock);

//      fibril_condvar_broadcast(&assoc->rcv_queue_cv);

        return EOK;
}

/** Send 'data' event to client.
 *
 * @param client Client
 */
static void udp_ev_data(udp_client_t *client)
{
        async_exch_t *exch;

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_ev_data()");

        exch = async_exchange_begin(client->sess);
        aid_t req = async_send_0(exch, UDP_EV_DATA, NULL);
        async_exchange_end(exch);

        async_forget(req);
}

/** Create client association.
 *
 * This effectively adds an association into a client's namespace.
 *
 * @param client  Client
 * @param assoc   Association
 * @param rcassoc Place to store pointer to new client association
 *
 * @return EOK on soccess, ENOMEM if out of memory
 */
static errno_t udp_cassoc_create(udp_client_t *client, udp_assoc_t *assoc,
    udp_cassoc_t **rcassoc)
{
        udp_cassoc_t *cassoc;
        sysarg_t id;

        cassoc = calloc(1, sizeof(udp_cassoc_t));
        if (cassoc == NULL)
                return ENOMEM;

        /* Allocate new ID */
        id = 0;
        list_foreach (client->cassoc, lclient, udp_cassoc_t, cassoc) {
                if (cassoc->id >= id)
                        id = cassoc->id + 1;
        }

        cassoc->id = id;
        cassoc->client = client;
        cassoc->assoc = assoc;

        list_append(&cassoc->lclient, &client->cassoc);
        *rcassoc = cassoc;
        return EOK;
}

/** Destroy client association.
 *
 * @param cassoc Client association
 */
static void udp_cassoc_destroy(udp_cassoc_t *cassoc)
{
        list_remove(&cassoc->lclient);
        free(cassoc);
}

/** Get client association by ID.
 *
 * @param client  Client
 * @param id      Client association ID
 * @param rcassoc Place to store pointer to client association
 *
 * @return EOK on success, ENOENT if no client association with the given ID
 *         is found.
 */
static errno_t udp_cassoc_get(udp_client_t *client, sysarg_t id,
    udp_cassoc_t **rcassoc)
{
        list_foreach (client->cassoc, lclient, udp_cassoc_t, cassoc) {
                if (cassoc->id == id) {
                        *rcassoc = cassoc;
                        return EOK;
                }
        }

        return ENOENT;
}

/** Message received on client association.
 *
 * Used as udp_assoc_cb.recv_msg callback.
 *
 * @param arg Callback argument, client association
 * @param epp Endpoint pair where message was received
 * @param msg Message
 */
static void udp_cassoc_recv_msg(void *arg, inet_ep2_t *epp, udp_msg_t *msg)
{
        udp_cassoc_t *cassoc = (udp_cassoc_t *) arg;

        udp_cassoc_queue_msg(cassoc, epp, msg);
        udp_ev_data(cassoc->client);
}

/** Create association.
 *
 * Handle client request to create association (with parameters unmarshalled).
 *
 * @param client    UDP client
 * @param epp       Endpoint pair
 * @param rassoc_id Place to store ID of new association
 *
 * @return EOK on success or an error code
 */
static errno_t udp_assoc_create_impl(udp_client_t *client, inet_ep2_t *epp,
    sysarg_t *rassoc_id)
{
        udp_assoc_t *assoc;
        udp_cassoc_t *cassoc;
        errno_t rc;

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_assoc_create_impl");

        assoc = udp_assoc_new(epp, NULL, NULL);
        if (assoc == NULL)
                return EIO;

        if (epp->local_link != 0)
                udp_assoc_set_iplink(assoc, epp->local_link);

        rc = udp_cassoc_create(client, assoc, &cassoc);
        if (rc != EOK) {
                assert(rc == ENOMEM);
                udp_assoc_delete(assoc);
                return ENOMEM;
        }

        assoc->cb = &udp_cassoc_cb;
        assoc->cb_arg = cassoc;

        rc = udp_assoc_add(assoc);
        if (rc != EOK) {
                udp_cassoc_destroy(cassoc);
                udp_assoc_delete(assoc);
                return rc;
        }

        *rassoc_id = cassoc->id;
        return EOK;
}

/** Destroy association.
 *
 * Handle client request to destroy association (with parameters unmarshalled).
 *
 * @param client   UDP client
 * @param assoc_id Association ID
 * @return EOK on success, ENOENT if no such association is found
 */
static errno_t udp_assoc_destroy_impl(udp_client_t *client, sysarg_t assoc_id)
{
        udp_cassoc_t *cassoc;
        errno_t rc;

        rc = udp_cassoc_get(client, assoc_id, &cassoc);
        if (rc != EOK) {
                assert(rc == ENOENT);
                return ENOENT;
        }

        udp_assoc_remove(cassoc->assoc);
        udp_assoc_reset(cassoc->assoc);
        udp_assoc_delete(cassoc->assoc);
        udp_cassoc_destroy(cassoc);
        return EOK;
}

/** Set association sending messages with no local address.
 *
 * Handle client request to set nolocal flag (with parameters unmarshalled).
 *
 * @param client   UDP client
 * @param assoc_id Association ID
 * @return EOK on success, ENOENT if no such association is found
 */
static errno_t udp_assoc_set_nolocal_impl(udp_client_t *client, sysarg_t assoc_id)
{
        udp_cassoc_t *cassoc;
        errno_t rc;

        rc = udp_cassoc_get(client, assoc_id, &cassoc);
        if (rc != EOK) {
                assert(rc == ENOENT);
                return ENOENT;
        }

        log_msg(LOG_DEFAULT, LVL_NOTE, "Setting nolocal to true");
        cassoc->assoc->nolocal = true;
        return EOK;
}

/** Send message via association.
 *
 * Handle client request to send message (with parameters unmarshalled).
 *
 * @param client   UDP client
 * @param assoc_id Association ID
 * @param dest     Destination endpoint or @c NULL to use the default from
 *                 association
 * @param data     Message data
 * @param size     Message size
 *
 * @return EOK on success or an error code
 */
static errno_t udp_assoc_send_msg_impl(udp_client_t *client, sysarg_t assoc_id,
    inet_ep_t *dest, void *data, size_t size)
{
        udp_msg_t msg;
        udp_cassoc_t *cassoc;
        errno_t rc;

        rc = udp_cassoc_get(client, assoc_id, &cassoc);
        if (rc != EOK)
                return rc;

        msg.data = data;
        msg.data_size = size;
        rc = udp_assoc_send(cassoc->assoc, dest, &msg);
        if (rc != EOK)
                return rc;

        return EOK;
}

/** Create callback session.
 *
 * Handle client request to create callback session.
 *
 * @param client   UDP client
 * @param iid      Async request ID
 * @param icall    Async request data
 */
static void udp_callback_create_srv(udp_client_t *client, cap_call_handle_t icall_handle,
    ipc_call_t *icall)
{
        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_callback_create_srv()");

        async_sess_t *sess = async_callback_receive(EXCHANGE_SERIALIZE);
        if (sess == NULL) {
                async_answer_0(icall_handle, ENOMEM);
                return;
        }

        client->sess = sess;
        async_answer_0(icall_handle, EOK);
}

/** Create association.
 *
 * Handle client request to create association.
 *
 * @param client   UDP client
 * @param iid      Async request ID
 * @param icall    Async request data
 */
static void udp_assoc_create_srv(udp_client_t *client, cap_call_handle_t icall_handle,
    ipc_call_t *icall)
{
        cap_call_handle_t chandle;
        size_t size;
        inet_ep2_t epp;
        sysarg_t assoc_id;
        errno_t rc;

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_assoc_create_srv()");

        if (!async_data_write_receive(&chandle, &size)) {
                async_answer_0(chandle, EREFUSED);
                async_answer_0(icall_handle, EREFUSED);
                return;
        }

        if (size != sizeof(inet_ep2_t)) {
                async_answer_0(chandle, EINVAL);
                async_answer_0(icall_handle, EINVAL);
                return;
        }

        rc = async_data_write_finalize(chandle, &epp, size);
        if (rc != EOK) {
                async_answer_0(chandle, rc);
                async_answer_0(icall_handle, rc);
                return;
        }

        rc = udp_assoc_create_impl(client, &epp, &assoc_id);
        if (rc != EOK) {
                async_answer_0(icall_handle, rc);
                return;
        }

        async_answer_1(icall_handle, EOK, assoc_id);
}

/** Destroy association.
 *
 * Handle client request to destroy association.
 *
 * @param client   UDP client
 * @param iid      Async request ID
 * @param icall    Async request data
 */
static void udp_assoc_destroy_srv(udp_client_t *client, cap_call_handle_t icall_handle,
    ipc_call_t *icall)
{
        sysarg_t assoc_id;
        errno_t rc;

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_assoc_destroy_srv()");

        assoc_id = IPC_GET_ARG1(*icall);
        rc = udp_assoc_destroy_impl(client, assoc_id);
        async_answer_0(icall_handle, rc);
}

/** Set association with no local address.
 *
 * Handle client request to set no local address flag.
 *
 * @param client   UDP client
 * @param iid      Async request ID
 * @param icall    Async request data
 */
static void udp_assoc_set_nolocal_srv(udp_client_t *client, cap_call_handle_t icall_handle,
    ipc_call_t *icall)
{
        sysarg_t assoc_id;
        errno_t rc;

        log_msg(LOG_DEFAULT, LVL_NOTE, "udp_assoc_set_nolocal_srv()");

        assoc_id = IPC_GET_ARG1(*icall);
        rc = udp_assoc_set_nolocal_impl(client, assoc_id);
        async_answer_0(icall_handle, rc);
}

/** Send message via association.
 *
 * Handle client request to send message.
 *
 * @param client   UDP client
 * @param iid      Async request ID
 * @param icall    Async request data
 */
static void udp_assoc_send_msg_srv(udp_client_t *client, cap_call_handle_t icall_handle,
    ipc_call_t *icall)
{
        cap_call_handle_t chandle;
        size_t size;
        inet_ep_t dest;
        sysarg_t assoc_id;
        void *data;
        errno_t rc;

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_assoc_send_msg_srv()");

        /* Receive dest */

        if (!async_data_write_receive(&chandle, &size)) {
                async_answer_0(chandle, EREFUSED);
                async_answer_0(icall_handle, EREFUSED);
                return;
        }

        if (size != sizeof(inet_ep_t)) {
                async_answer_0(chandle, EINVAL);
                async_answer_0(icall_handle, EINVAL);
                return;
        }

        rc = async_data_write_finalize(chandle, &dest, size);
        if (rc != EOK) {
                async_answer_0(chandle, rc);
                async_answer_0(icall_handle, rc);
                return;
        }

        /* Receive message data */

        if (!async_data_write_receive(&chandle, &size)) {
                async_answer_0(chandle, EREFUSED);
                async_answer_0(icall_handle, EREFUSED);
                return;
        }

        if (size > MAX_MSG_SIZE) {
                async_answer_0(chandle, EINVAL);
                async_answer_0(icall_handle, EINVAL);
                return;
        }

        data = malloc(size);
        if (data == NULL) {
                async_answer_0(chandle, ENOMEM);
                async_answer_0(icall_handle, ENOMEM);
        }

        rc = async_data_write_finalize(chandle, data, size);
        if (rc != EOK) {
                async_answer_0(chandle, rc);
                async_answer_0(icall_handle, rc);
                free(data);
                return;
        }

        assoc_id = IPC_GET_ARG1(*icall);

        rc = udp_assoc_send_msg_impl(client, assoc_id, &dest, data, size);
        if (rc != EOK) {
                async_answer_0(icall_handle, rc);
                free(data);
                return;
        }

        async_answer_0(icall_handle, EOK);
        free(data);
}

/** Get next received message.
 *
 * @param client UDP Client
 * @return Pointer to queue entry for next received message
 */
static udp_crcv_queue_entry_t *udp_rmsg_get_next(udp_client_t *client)
{
        link_t *link;

        link = list_first(&client->crcv_queue);
        if (link == NULL)
                return NULL;

        return list_get_instance(link, udp_crcv_queue_entry_t, link);
}

/** Get info on first received message.
 *
 * Handle client request to get information on received message.
 *
 * @param client   UDP client
 * @param iid      Async request ID
 * @param icall    Async request data
 */
static void udp_rmsg_info_srv(udp_client_t *client, cap_call_handle_t icall_handle,
    ipc_call_t *icall)
{
        cap_call_handle_t chandle;
        size_t size;
        udp_crcv_queue_entry_t *enext;
        sysarg_t assoc_id;
        errno_t rc;

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_rmsg_info_srv()");
        enext = udp_rmsg_get_next(client);

        if (!async_data_read_receive(&chandle, &size)) {
                async_answer_0(chandle, EREFUSED);
                async_answer_0(icall_handle, EREFUSED);
                return;
        }

        if (enext == NULL) {
                async_answer_0(chandle, ENOENT);
                async_answer_0(icall_handle, ENOENT);
                return;
        }

        rc = async_data_read_finalize(chandle, &enext->epp.remote,
            max(size, (size_t)sizeof(inet_ep_t)));
        if (rc != EOK) {
                async_answer_0(icall_handle, rc);
                return;
        }

        assoc_id = enext->cassoc->id;
        size = enext->msg->data_size;

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_rmsg_info_srv(): assoc_id=%zu, "
            "size=%zu", assoc_id, size);
        async_answer_2(icall_handle, EOK, assoc_id, size);
}

/** Read data from first received message.
 *
 * Handle client request to read data from first received message.
 *
 * @param client   UDP client
 * @param iid      Async request ID
 * @param icall    Async request data
 */
static void udp_rmsg_read_srv(udp_client_t *client, cap_call_handle_t icall_handle,
    ipc_call_t *icall)
{
        cap_call_handle_t chandle;
        size_t msg_size;
        udp_crcv_queue_entry_t *enext;
        void *data;
        size_t size;
        size_t off;
        errno_t rc;

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_rmsg_read_srv()");
        off = IPC_GET_ARG1(*icall);

        enext = udp_rmsg_get_next(client);

        if (!async_data_read_receive(&chandle, &size)) {
                async_answer_0(chandle, EREFUSED);
                async_answer_0(icall_handle, EREFUSED);
                return;
        }

        if (enext == NULL) {
                async_answer_0(chandle, ENOENT);
                async_answer_0(icall_handle, ENOENT);
                return;
        }

        data = enext->msg->data + off;
        msg_size = enext->msg->data_size;

        if (off > msg_size) {
                async_answer_0(chandle, EINVAL);
                async_answer_0(icall_handle, EINVAL);
                return;
        }

        rc = async_data_read_finalize(chandle, data, min(msg_size - off, size));
        if (rc != EOK) {
                async_answer_0(icall_handle, rc);
                return;
        }

        async_answer_0(icall_handle, EOK);
        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_rmsg_read_srv(): OK");
}

/** Discard first received message.
 *
 * Handle client request to discard first received message, advancing
 * to the next one.
 *
 * @param client   UDP client
 * @param iid      Async request ID
 * @param icall    Async request data
 */
static void udp_rmsg_discard_srv(udp_client_t *client, cap_call_handle_t icall_handle,
    ipc_call_t *icall)
{
        udp_crcv_queue_entry_t *enext;

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_rmsg_discard_srv()");

        enext = udp_rmsg_get_next(client);
        if (enext == NULL) {
                log_msg(LOG_DEFAULT, LVL_DEBUG, "usg_rmsg_discard_srv: enext==NULL");
                async_answer_0(icall_handle, ENOENT);
                return;
        }

        list_remove(&enext->link);
        udp_msg_delete(enext->msg);
        free(enext);
        async_answer_0(icall_handle, EOK);
}

/** Handle UDP client connection.
 *
 * @param icall_handle  Connect call handle 
 * @param icall         Connect call data
 * @param arg           Connection argument
 */
static void udp_client_conn(cap_call_handle_t icall_handle, ipc_call_t *icall,
    void *arg)
{
        udp_client_t client;
        unsigned long n;

        /* Accept the connection */
        async_answer_0(icall_handle, EOK);

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_client_conn()");

        client.sess = NULL;
        list_initialize(&client.cassoc);
        list_initialize(&client.crcv_queue);

        while (true) {
                log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_client_conn: wait req");
                ipc_call_t call;
                cap_call_handle_t chandle = async_get_call(&call);
                sysarg_t method = IPC_GET_IMETHOD(call);

                log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_client_conn: method=%d",
                    (int)method);
                if (!method) {
                        /* The other side has hung up */
                        async_answer_0(chandle, EOK);
                        break;
                }

                switch (method) {
                case UDP_CALLBACK_CREATE:
                        udp_callback_create_srv(&client, chandle, &call);
                        break;
                case UDP_ASSOC_CREATE:
                        udp_assoc_create_srv(&client, chandle, &call);
                        break;
                case UDP_ASSOC_DESTROY:
                        udp_assoc_destroy_srv(&client, chandle, &call);
                        break;
                case UDP_ASSOC_SET_NOLOCAL:
                        udp_assoc_set_nolocal_srv(&client, chandle, &call);
                        break;
                case UDP_ASSOC_SEND_MSG:
                        udp_assoc_send_msg_srv(&client, chandle, &call);
                        break;
                case UDP_RMSG_INFO:
                        udp_rmsg_info_srv(&client, chandle, &call);
                        break;
                case UDP_RMSG_READ:
                        udp_rmsg_read_srv(&client, chandle, &call);
                        break;
                case UDP_RMSG_DISCARD:
                        udp_rmsg_discard_srv(&client, chandle, &call);
                        break;
                default:
                        async_answer_0(chandle, ENOTSUP);
                        break;
                }
        }

        log_msg(LOG_DEFAULT, LVL_DEBUG, "udp_client_conn: terminated");

        n = list_count(&client.cassoc);
        if (n != 0) {
                log_msg(LOG_DEFAULT, LVL_WARN, "udp_client_conn: "
                    "Client with %lu active associations closed session.", n);
                /* XXX Clean up */
        }

        /* XXX Clean up client receive queue */

        if (client.sess != NULL)
                async_hangup(client.sess);
}

/** Initialize UDP service.
 *
 * @return EOK on success or an error code.
 */
errno_t udp_service_init(void)
{
        errno_t rc;
        service_id_t sid;

        async_set_fallback_port_handler(udp_client_conn, NULL);

        rc = loc_server_register(NAME);
        if (rc != EOK) {
                log_msg(LOG_DEFAULT, LVL_ERROR, "Failed registering server.");
                return EIO;
        }

        rc = loc_service_register(SERVICE_NAME_UDP, &sid);
        if (rc != EOK) {
                log_msg(LOG_DEFAULT, LVL_ERROR, "Failed registering service.");
                return EIO;
        }

        return EOK;
}

/**
 * @}
 */