source: mainline/uspace/srv/net/ethip/ethip.c@ 1d24ad3

/*
 * Copyright (c) 2012 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 ethip
 * @{
 */
/**
 * @file
 * @brief IP link provider for Ethernet
 *
 * Based on the IETF RFC 894 standard.
 */

#include <async.h>
#include <errno.h>
#include <inet/iplink_srv.h>
#include <io/log.h>
#include <loc.h>
#include <stdio.h>
#include <stdlib.h>
#include <net/socket_codes.h>
#include "arp.h"
#include "ethip.h"
#include "ethip_nic.h"
#include "pdu.h"
#include "std.h"

#define NAME "ethip"

static int ethip_open(iplink_srv_t *srv);
static int ethip_close(iplink_srv_t *srv);
static int ethip_send(iplink_srv_t *srv, iplink_sdu_t *sdu);
static int ethip_get_mtu(iplink_srv_t *srv, size_t *mtu);
static int ethip_addr_add(iplink_srv_t *srv, inet_addr_t *addr);
static int ethip_addr_remove(iplink_srv_t *srv, inet_addr_t *addr);

static void ethip_client_conn(ipc_callid_t iid, ipc_call_t *icall, void *arg);

static iplink_ops_t ethip_iplink_ops = {
        .open = ethip_open,
        .close = ethip_close,
        .send = ethip_send,
        .get_mtu = ethip_get_mtu,
        .addr_add = ethip_addr_add,
        .addr_remove = ethip_addr_remove
};

static int ethip_init(void)
{
        async_set_client_connection(ethip_client_conn);
        
        int rc = loc_server_register(NAME);
        if (rc != EOK) {
                log_msg(LOG_DEFAULT, LVL_ERROR, "Failed registering server.");
                return rc;
        }
        
        rc = ethip_nic_discovery_start();
        if (rc != EOK)
                return rc;
        
        return EOK;
}

int ethip_iplink_init(ethip_nic_t *nic)
{
        int rc;
        service_id_t sid;
        category_id_t iplink_cat;
        static unsigned link_num = 0;
        char *svc_name = NULL;

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

        iplink_srv_init(&nic->iplink);
        nic->iplink.ops = &ethip_iplink_ops;
        nic->iplink.arg = nic;

        rc = asprintf(&svc_name, "net/eth%u", ++link_num);
        if (rc < 0) {
                log_msg(LOG_DEFAULT, LVL_ERROR, "Out of memory.");
                goto error;
        }

        rc = loc_service_register(svc_name, &sid);
        if (rc != EOK) {
                log_msg(LOG_DEFAULT, LVL_ERROR, "Failed registering service %s.", svc_name);
                goto error;
        }

        nic->iplink_sid = sid;

        rc = loc_category_get_id("iplink", &iplink_cat, IPC_FLAG_BLOCKING);
        if (rc != EOK) {
                log_msg(LOG_DEFAULT, LVL_ERROR, "Failed resolving category 'iplink'.");
                goto error;
        }

        rc = loc_service_add_to_cat(sid, iplink_cat);
        if (rc != EOK) {
                log_msg(LOG_DEFAULT, LVL_ERROR, "Failed adding %s to category.", svc_name);
                goto error;
        }

        return EOK;

error:
        if (svc_name != NULL)
                free(svc_name);
        return rc;
}

static void ethip_client_conn(ipc_callid_t iid, ipc_call_t *icall, void *arg)
{
        ethip_nic_t *nic;
        service_id_t sid;

        sid = (service_id_t)IPC_GET_ARG1(*icall);
        log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_client_conn(%u)", (unsigned)sid);
        nic = ethip_nic_find_by_iplink_sid(sid);
        if (nic == NULL) {
                log_msg(LOG_DEFAULT, LVL_WARN, "Uknown service ID.");
                return;
        }

        iplink_conn(iid, icall, &nic->iplink);
}

static int ethip_open(iplink_srv_t *srv)
{
        log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_open()");
        return EOK;
}

static int ethip_close(iplink_srv_t *srv)
{
        log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_close()");
        return EOK;
}

static int ethip_send(iplink_srv_t *srv, iplink_sdu_t *sdu)
{
        log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_send()");
        
        ethip_nic_t *nic = (ethip_nic_t *) srv->arg;
        
        addr32_t src_v4;
        addr128_t src_v6;
        uint16_t src_af = inet_addr_get(&sdu->src, &src_v4, &src_v6);
        
        addr32_t dest_v4;
        addr128_t dest_v6;
        uint16_t dest_af = inet_addr_get(&sdu->dest, &dest_v4, &dest_v6);
        
        if (src_af != dest_af)
                return EINVAL;
        
        int rc;
        eth_frame_t frame;
        
        switch (src_af) {
        case AF_INET:
                rc = arp_translate(nic, src_v4, dest_v4, frame.dest);
                if (rc != EOK) {
                        log_msg(LOG_DEFAULT, LVL_WARN, "Failed to look up IPv4 address 0x%"
                            PRIx32, dest_v4);
                        return rc;
                }
                
                addr48(nic->mac_addr, frame.src);
                frame.etype_len = ETYPE_IP;
                frame.data = sdu->data;
                frame.size = sdu->size;
                
                break;
        case AF_INET6:
                // FIXME TODO
                return ENOTSUP;
        default:
                return EINVAL;
        }
        
        void *data;
        size_t size;
        rc = eth_pdu_encode(&frame, &data, &size);
        if (rc != EOK)
                return rc;
        
        rc = ethip_nic_send(nic, data, size);
        free(data);
        
        return rc;
}

int ethip_received(iplink_srv_t *srv, void *data, size_t size)
{
        log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_received(): srv=%p", srv);
        ethip_nic_t *nic = (ethip_nic_t *) srv->arg;
        
        log_msg(LOG_DEFAULT, LVL_DEBUG, " - eth_pdu_decode");
        
        eth_frame_t frame;
        int rc = eth_pdu_decode(data, size, &frame);
        if (rc != EOK) {
                log_msg(LOG_DEFAULT, LVL_DEBUG, " - eth_pdu_decode failed");
                return rc;
        }
        
        iplink_recv_sdu_t sdu;
        
        switch (frame.etype_len) {
        case ETYPE_ARP:
                arp_received(nic, &frame);
                break;
        case ETYPE_IP:
                log_msg(LOG_DEFAULT, LVL_DEBUG, " - construct SDU");
                sdu.data = frame.data;
                sdu.size = frame.size;
                log_msg(LOG_DEFAULT, LVL_DEBUG, " - call iplink_ev_recv");
                rc = iplink_ev_recv(&nic->iplink, &sdu, AF_INET);
                break;
        case ETYPE_IPV6:
                log_msg(LOG_DEFAULT, LVL_DEBUG, " - construct SDU IPv6");
                sdu.data = frame.data;
                sdu.size = frame.size;
                log_msg(LOG_DEFAULT, LVL_DEBUG, " - call iplink_ev_recv");
                rc = iplink_ev_recv(&nic->iplink, &sdu, AF_INET6);
                break;
        default:
                log_msg(LOG_DEFAULT, LVL_DEBUG, "Unknown ethertype 0x%" PRIx16,
                    frame.etype_len);
        }
        
        free(frame.data);
        return rc;
}

static int ethip_get_mtu(iplink_srv_t *srv, size_t *mtu)
{
        log_msg(LOG_DEFAULT, LVL_DEBUG, "ethip_get_mtu()");
        *mtu = 1500;
        return EOK;
}

static int ethip_addr_add(iplink_srv_t *srv, inet_addr_t *addr)
{
        ethip_nic_t *nic = (ethip_nic_t *) srv->arg;
        
        return ethip_nic_addr_add(nic, addr);
}

static int ethip_addr_remove(iplink_srv_t *srv, inet_addr_t *addr)
{
        ethip_nic_t *nic = (ethip_nic_t *) srv->arg;
        
        return ethip_nic_addr_remove(nic, addr);
}

int main(int argc, char *argv[])
{
        int rc;

        printf(NAME ": HelenOS IP over Ethernet service\n");

        if (log_init(NAME) != EOK) {
                printf(NAME ": Failed to initialize logging.\n");
                return 1;
        }

        rc = ethip_init();
        if (rc != EOK)
                return 1;

        printf(NAME ": Accepting connections.\n");
        task_retval(0);
        async_manager();

        /* Not reached */
        return 0;
}

/** @}
 */