tl_common.c

Go to the documentation of this file.

/*
 * Copyright (c) 2008 Lukas Mejdrech
 * 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.
 */

#include <tl_common.h>
#include <packet_client.h>
#include <packet_remote.h>
#include <icmp_remote.h>
#include <ip_remote.h>
#include <ip_interface.h>
#include <tl_remote.h>

#include <net/socket_codes.h>
#include <net/in.h>
#include <net/in6.h>
#include <net/inet.h>
#include <net/device.h>
#include <net/packet.h>

#include <async.h>
#include <ipc/services.h>
#include <errno.h>

DEVICE_MAP_IMPLEMENT(packet_dimensions, packet_dimension_t);

int
tl_get_address_port(const struct sockaddr *addr, int addrlen, uint16_t *port)
{
        const struct sockaddr_in *address_in;
        const struct sockaddr_in6 *address_in6;

        if ((addrlen <= 0) || ((size_t) addrlen < sizeof(struct sockaddr)))
                return EINVAL;

        switch (addr->sa_family) {
        case AF_INET:
                if (addrlen != sizeof(struct sockaddr_in))
                        return EINVAL;

                address_in = (struct sockaddr_in *) addr;
                *port = ntohs(address_in->sin_port);
                break;
        
        case AF_INET6:
                if (addrlen != sizeof(struct sockaddr_in6))
                        return EINVAL;

                address_in6 = (struct sockaddr_in6 *) addr;
                *port = ntohs(address_in6->sin6_port);
                break;
        
        default:
                return EAFNOSUPPORT;
        }

        return EOK;
}

int
tl_get_ip_packet_dimension(int ip_phone,
    packet_dimensions_t *packet_dimensions, device_id_t device_id,
    packet_dimension_t **packet_dimension)
{
        int rc;
        
        if (!packet_dimension)
                return EBADMEM;
        
        *packet_dimension = packet_dimensions_find(packet_dimensions,
            device_id);
        if (!*packet_dimension) {
                /* Ask for and remember them if not found */
                *packet_dimension = malloc(sizeof(**packet_dimension));
                if(!*packet_dimension)
                        return ENOMEM;
                
                rc = ip_packet_size_req(ip_phone, device_id, *packet_dimension);
                if (rc != EOK) {
                        free(*packet_dimension);
                        return rc;
                }
                
                rc = packet_dimensions_add(packet_dimensions, device_id,
                    *packet_dimension);
                if (rc < 0) {
                        free(*packet_dimension);
                        return rc;
                }
        }
        
        return EOK;
}

int
tl_update_ip_packet_dimension(packet_dimensions_t *packet_dimensions,
    device_id_t device_id, size_t content)
{
        packet_dimension_t *packet_dimension;

        packet_dimension = packet_dimensions_find(packet_dimensions, device_id);
        if (!packet_dimension)
                return ENOENT;

        packet_dimension->content = content;

        if (device_id != DEVICE_INVALID_ID) {
                packet_dimension = packet_dimensions_find(packet_dimensions,
                    DEVICE_INVALID_ID);

                if (packet_dimension) {
                        if (packet_dimension->content >= content)
                                packet_dimension->content = content;
                        else
                                packet_dimensions_exclude(packet_dimensions,
                                    DEVICE_INVALID_ID, free);
                }
        }

        return EOK;
}

int tl_set_address_port(struct sockaddr * addr, int addrlen, uint16_t port)
{
        struct sockaddr_in *address_in;
        struct sockaddr_in6 *address_in6;
        size_t length;

        if (addrlen < 0)
                return EINVAL;
        
        length = (size_t) addrlen;
        if (length < sizeof(struct sockaddr))
                return EINVAL;

        switch (addr->sa_family) {
        case AF_INET:
                if (length != sizeof(struct sockaddr_in))
                        return EINVAL;
                address_in = (struct sockaddr_in *) addr;
                address_in->sin_port = htons(port);
                return EOK;
        
        case AF_INET6:
                if (length != sizeof(struct sockaddr_in6))
                                return EINVAL;
                address_in6 = (struct sockaddr_in6 *) addr;
                address_in6->sin6_port = htons(port);
                return EOK;
        
        default:
                return EAFNOSUPPORT;
        }
}

int
tl_prepare_icmp_packet(int packet_phone, int icmp_phone, packet_t *packet,
    services_t error)
{
        packet_t *next;
        uint8_t *src;
        int length;

        /* Detach the first packet and release the others */
        next = pq_detach(packet);
        if (next)
                pq_release_remote(packet_phone, packet_get_id(next));
        
        length = packet_get_addr(packet, &src, NULL);
        if ((length > 0) && (!error) && (icmp_phone >= 0) &&
            /*
             * Set both addresses to the source one (avoids the source address
             * deletion before setting the destination one)
             */
            (packet_set_addr(packet, src, src, (size_t) length) == EOK)) {
                return EOK;
        } else
                pq_release_remote(packet_phone, packet_get_id(packet));

        return ENOENT;
}

int
tl_socket_read_packet_data(int packet_phone, packet_t **packet, size_t prefix,
    const packet_dimension_t *dimension, const struct sockaddr *addr,
    socklen_t addrlen)
{
        ipc_callid_t callid;
        size_t length;
        void *data;
        int rc;

        if (!dimension)
                return EINVAL;

        /* Get the data length */
        if (!async_data_write_receive(&callid, &length))
                return EINVAL;

        /* Get a new packet */
        *packet = packet_get_4_remote(packet_phone, length, dimension->addr_len,
            prefix + dimension->prefix, dimension->suffix);
        if (!packet)
                return ENOMEM;

        /* Allocate space in the packet */
        data = packet_suffix(*packet, length);
        if (!data) {
                pq_release_remote(packet_phone, packet_get_id(*packet));
                return ENOMEM;
        }

        /* Read the data into the packet */
        rc = async_data_write_finalize(callid, data, length);
        if (rc != EOK) {
                pq_release_remote(packet_phone, packet_get_id(*packet));
                return rc;
        }
        
        /* Set the packet destination address */
        rc = packet_set_addr(*packet, NULL, (uint8_t *) addr, addrlen);
        if (rc != EOK) {
                pq_release_remote(packet_phone, packet_get_id(*packet));
                return rc;
        }

        return (int) length;
}

---