Subversion Repositories HelenOS

/*

 * Copyright (c) 2009 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.

 */

/** @addtogroup ip

 *  @{

 */

/** @file

 */

#include <async.h>

#include <errno.h>

#include <stdio.h>

#include <ipc/ipc.h>

#include <ipc/services.h>

#include "../../err.h"

#include "../../messages.h"

#include "../../modules.h"

#include "../../include/sockaddr.h"

#include "../../include/socket.h"

#include "../../include/device.h"

#include "../../include/arp_messages.h"

#include "../../include/nil_messages.h"

#include "../../structures/measured_strings.h"

#include "../../structures/module_map.h"

#include "../../structures/packet/packet_client.h"

#include "ip.h"

#include "ip_messages.h"

#include "ip_module.h"

#define DEFAULT_IPV     4

#define ARP_NAME                "arp"

#define ARP_FILENAME            "/srv/arp"

#define IPC_GET_PROTO( call )       ( int ) IPC_GET_ARG1( * call )

#define IPC_GET_STATE( call )       ( device_state_t ) IPC_GET_ARG2( * call )

#define IPC_GET_PHONE( call )       ( int ) IPC_GET_ARG5( * call )

ip_globals_t    ip_globals;

DEVICE_MAP_IMPLEMENT( ip_netifs, ip_netif_t )

INT_MAP_IMPLEMENT( ip_protos, ip_proto_t )

int ip_register_message( int protocol, int phone );

int ip_state_message( device_id_t device_id, device_state_t state );

void    ip_driver_receiver( ipc_callid_t iid, ipc_call_t * icall );

/** Initializes the module.

 */

int ip_initialize( void ){

    ERROR_DECLARE;

    ERROR_PROPAGATE( ip_netifs_initialize( & ip_globals.netifs ));

    ERROR_PROPAGATE( ip_protos_initialize( & ip_globals.protos ));

    ERROR_PROPAGATE( modules_initialize( & ip_globals.modules ));

    ERROR_PROPAGATE( add_module( NULL, & ip_globals.modules, ARP_NAME, ARP_FILENAME, SERVICE_ARP, 0 ));

    return EOK;

}

int ip_echo_message( ipcarg_t arg1, ipcarg_t arg2, ipcarg_t arg3, ipcarg_t arg4, ipcarg_t arg5, ipcarg_t * answer1, ipcarg_t * answer2, ipcarg_t * answer3, ipcarg_t * answer4, ipcarg_t * answer5 ){

    if( answer1 ) * answer1 = arg1;

    if( answer2 ) * answer2 = arg2;

    if( answer3 ) * answer3 = arg3;

    if( answer4 ) * answer4 = arg4;

    if( answer5 ) * answer5 = arg5;

    return EOK;

}

int ip_device_message( device_id_t device_id, services_t service ){

    ERROR_DECLARE;

    ip_netif_ref    ip_netif;

    aid_t           message;

    ipc_call_t      answer;

    measured_string_t   configuration[ 9 ] = {{ "IPV", 3 }, { "IP_CONFIG", 9 }, { "IP_ADDR", 7 }, { "NETMASK", 7 }, { "GATEWAY", 7 }, { "BROADCAST", 9 }, { "DNS1", 4 }, { "DNS2", 4 }, { "ARP", 3 }};

    int         count = 9;

    measured_string_ref settings;

    char *          data;

    ipcarg_t        result;

    int             index;

    ip_netif = ( ip_netif_ref ) malloc( sizeof( ip_netif_t ));

    if( ! ip_netif ) return ENOMEM;

    ip_netif->device_id = device_id;

    // get configuration

    // TODO mapping

    message = async_send_2( ip_globals.networking_phone, NET_NET_GET_DEVICE_CONF, ip_netif->device_id, count, & answer );

    // send names and get settings

    if( ERROR_OCCURRED( measured_strings_send( ip_globals.networking_phone, configuration, count ))

    || ERROR_OCCURRED( measured_strings_return( ip_globals.networking_phone, & settings, & data, count ))){

        async_wait_for( message, NULL );

        free( ip_netif );

        return ERROR_CODE;

    }

    async_wait_for( message, & result );

    if( ERROR_OCCURRED( result )){

        if( settings ){

            free( settings );

            free( data );

        };

        free( ip_netif );

        return ERROR_CODE;

    }

    if( settings ){

        if( settings[ 0 ].value ){

            ip_netif->ipv = strtol( settings[ 0 ].value, NULL, 0 );

        }else{

            ip_netif->ipv = DEFAULT_IPV;

        }

        ip_netif->dhcp = ! strncmp( settings[ 1 ].value, "dhcp", 4 );

        if( ip_netif->dhcp ){

            // TODO dhcp

            free( settings );

            free( data );

            free( ip_netif );

            return ENOTSUP;

        }else if( ip_netif->ipv == 4 ){

            if( ERROR_OCCURRED( inet_pton( AF_INET, settings[ 2 ].value, ( uint8_t * ) & ip_netif->address ))

            || ERROR_OCCURRED( inet_pton( AF_INET, settings[ 3 ].value, ( uint8_t * ) & ip_netif->netmask ))

            || ( inet_pton( AF_INET, settings[ 4 ].value, ( uint8_t * ) & ip_netif->gateway ) == EINVAL )

            || ( inet_pton( AF_INET, settings[ 5 ].value, ( uint8_t * ) & ip_netif->broadcast ) == EINVAL )

            || ( inet_pton( AF_INET, settings[ 6 ].value, ( uint8_t * ) & ip_netif->dns1 ) == EINVAL )

            || ( inet_pton( AF_INET, settings[ 7 ].value, ( uint8_t * ) & ip_netif->dns2 ) == EINVAL )){

                free( settings );

                free( data );

                free( ip_netif );

                return EINVAL;

            }

        }else{

            // TODO ipv6

            free( settings );

            free( data );

            free( ip_netif );

            return ENOTSUP;

        }

        if( settings[ 8 ].value ){

            ip_netif->arp = get_running_module( & ip_globals.modules, settings[ 8 ].value );

            if( ! ip_netif->arp ){

                printf( "\nFailed to start the arp %s", settings[ 8 ].value );

                free( settings );

                free( data );

                free( ip_netif );

                return EINVAL;

            }

        }else{

            ip_netif->arp = NULL;

        }

        free( settings );

        free( data );

    }

    ip_netif->phone = bind_service( service, ip_netif->device_id, SERVICE_IP, 0, ip_driver_receiver );

    if( ip_netif->phone < 0 ){

        printf( "\nFailed to contact the nil service %d", service );

        free( ip_netif );

        return ip_netif->phone;

    }

    if( ip_netif->arp ){

        configuration[ 0 ].value = ( char * ) & ip_netif->address;

        configuration[ 0 ].length = CONVERT_SIZE( in_addr_t, char, 1 );

        if( ERROR_OCCURRED( arp_device_req( ip_netif->arp->phone, ip_netif->device_id, SERVICE_IP, service, & configuration[ 0 ] ))){

            free( ip_netif );

            return ERROR_CODE;

        }

    }

    index = ip_netifs_add( & ip_globals.netifs, ip_netif->device_id, ip_netif );

    if( index < 0 ){

        free( ip_netif );

        return index;

    }

    if( ip_netif->arp ) ++ ip_netif->arp->usage;

    // print the settings

    printf( "\nNew device registered:\n\tid\t= %d\n\tphone\t= %d\n\tIPV\t= %d", ip_netif->device_id, ip_netif->phone, ip_netif->ipv );

    printf( "\n\tconfiguration\t= %s", ip_netif->dhcp ? "dhcp" : "static" );

    // TODO ipv6 addresses

    data = malloc( INET_ADDRSTRLEN );

    if( data ){

        inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->address, data, INET_ADDRSTRLEN );

        printf( "\n\taddress\t= %s", data );

        inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->netmask, data, INET_ADDRSTRLEN );

        printf( "\n\tnetmask\t= %s", data );

        inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->gateway, data, INET_ADDRSTRLEN );

        printf( "\n\tgateway\t= %s", data );

        inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->broadcast, data, INET_ADDRSTRLEN );

        printf( "\n\tbroadcast\t= %s", data );

        inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns1, data, INET_ADDRSTRLEN );

        printf( "\n\tdns1\t= %s", data );

        inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns2, data, INET_ADDRSTRLEN );

        printf( "\n\tdns2\t= %s", data );

        free( data );

    }

    return EOK;

}

void ip_driver_receiver( ipc_callid_t iid, ipc_call_t * icall ){

    ERROR_DECLARE;

    ipc_callid_t    callid;

    ipc_call_t  call;

//  ipc_call_t  answer;

//  int     count;

    int     result;

    packet_t    packet;

    /*

     * Accept the connection

     *  - Answer the first IPC_M_CONNECT_ME_TO call.

     */

    ipc_answer_0( iid, EOK );

    while( true ){

/*      // refresh data

        count = 0;

        IPC_SET_RETVAL( answer, 0 );

        // just to be precize

        IPC_SET_RETVAL( answer, 0 );

        IPC_SET_ARG1( answer, 0 );

        IPC_SET_ARG2( answer, 0 );

        IPC_SET_ARG3( answer, 0 );

        IPC_SET_ARG4( answer, 0 );

        IPC_SET_ARG5( answer, 0 );

*/

        callid = async_get_call( & call );

        switch( IPC_GET_METHOD( call )){

            case NET_IL_DEVICE_STATE:

            case NET_NIL_DEVICE_STATE:

                result = ip_state_message( IPC_GET_DEVICE( & call ), IPC_GET_STATE( & call ));

                ipc_answer_0( callid, result );

            // TODO packer received

            case NET_IL_RECEIVED:

            case NET_NIL_RECEIVED:

                if( ! ERROR_OCCURRED( result = packet_translate( ip_globals.networking_phone, & packet, IPC_GET_PACKET( & call )))){

                    //result = ip_receive_message( IPC_GET_DEVICE( call ), packet );

                }

                ipc_answer_0( callid, result );

        }

    }

}

int ip_state_message( device_id_t device_id, device_state_t state ){

    ERROR_DECLARE;

    ip_netif_ref    netif;

    measured_string_t address;

    measured_string_ref translation;

    char *          data;

    netif = ip_netifs_find( & ip_globals.netifs, device_id );

    if( ! netif ) return ENOENT;

    // TODO state

    printf( "\nip - device %d changed state to %d\n", device_id, state );

    if( netif->arp ){

        address.value = ( char * ) & netif->gateway;

        address.length = CONVERT_SIZE( in_addr_t, char, 1 );

        ERROR_PROPAGATE( arp_translate_req( netif->arp->phone, netif->device_id, SERVICE_IP, & address, & translation, & data ));

        printf( "\n\tgateway translated to\t= %X:%X:%X:%X:%X:%X", data[ 0 ], data[ 1 ], data[ 2 ], data[ 3 ], data[ 4 ], data[ 5 ] );

        free( translation );

        free( data );

    }

    return EOK;

}

int ip_register_message( int protocol, int phone ){

    ip_proto_ref    proto;

    int             index;

    proto = ( ip_proto_ref ) malloc( sizeof( ip_protos_t ));

    if( ! proto ) return ENOMEM;

    proto->protocol = protocol;

    proto->phone = phone;

    index = ip_protos_add( & ip_globals.protos, proto->protocol, proto );

    if( index < 0 ){

        free( proto );

        return index;

    }

    printf( "\nNew protocol registered:\n\tprotocol\t= %d\n\tphone\t= %d", proto->protocol, proto->phone );

    return EOK;

}

int ip_send_message( device_id_t device_id, packet_t packet ){

    // TODO send packet

    printf( "Packet to send via %d: %s", device_id, packet_get_data( packet ));

    pq_release( ip_globals.networking_phone, packet_get_id( packet ));

    return EOK;

}

int ip_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){

    ERROR_DECLARE;

    packet_t    packet;

    * answer_count = 0;

    switch( IPC_GET_METHOD( * call )){

        case IPC_M_PHONE_HUNGUP:

            return EOK;

        case NET_IP_ECHO:

            * answer_count = 5;

            return ip_echo_message( IPC_GET_ARG1( * call ), IPC_GET_ARG2( * call ), IPC_GET_ARG3( * call ), IPC_GET_ARG4( * call ), IPC_GET_ARG5( * call ), & IPC_GET_ARG1( * answer ), & IPC_GET_ARG2( * answer ), & IPC_GET_ARG3( * answer ), & IPC_GET_ARG4( * answer ), & IPC_GET_ARG5( * answer ) );

        case NET_IL_DEVICE:

            return ip_device_message( IPC_GET_DEVICE( call ), IPC_GET_SERVICE( call ));

        case IPC_M_CONNECT_TO_ME:

            return ip_register_message( IPC_GET_PROTO( call ), IPC_GET_PHONE( call ));

        case NET_IP_SEND:

            ERROR_PROPAGATE( packet_translate( ip_globals.networking_phone, & packet, IPC_GET_PACKET( call )));

            return ip_send_message( IPC_GET_DEVICE( call ), packet );

    }

    return ENOTSUP;

}

/** @}

 */