Subversion Repositories HelenOS

#include <ctype.h>

#include <malloc.h>

//#include <thread.h>

#include <unistd.h>

#include "../char_map.h"

#include "../generic_char_map.h"

#include "../measured_strings.h"

#include "../modules.h"

//#include "../self_test.h"

#include "../netif/netif_device_id_type.h"

DEVICE_MAP_DECLARE( netifs, netif_t )

struct module_struct{

    task_id_t   task_id;

    services_t  service;

    int     phone;

    const char *    name;

    const char *    filename;

 */

     */

    /** A serving network interface driver module index.

    /** A serving link layer module index.

    module_ref      link_layer_module;

    /** A serving internet layer module index.

    module_ref      internet_layer_module;

    /** Configuration.

    measured_strings_t  configuration;

};

/** A networking module global variables.

 */

struct networking_globals{

    /** Present network interfaces.

     */

    netifs_t        netifs;

    /** Network interface structure indices by names.

     */

    char_map_t      netif_names;

    /** Available modules.

     */

    modules_t       modules;

    /** Global configuration.

     */

    measured_strings_t  configuration;

};

int     add_module( module_ref * module, modules_ref modules, const char const * name, const char const * filename, services_t service, task_id_t task_id );

static void client_connection( ipc_callid_t iid, ipc_call_t * icall );

measured_string_ref configuration_find( measured_strings_ref configuration, const char * name );

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

int     networking_call( ipc_callid_t callid );

int     networking_initialize( void );

int     networking_message( ipcarg_t method, ipcarg_t arg1, ipcarg_t arg2, ipcarg_t arg3, ipcarg_t * result1, ipcarg_t * result2, ipcarg_t * result3 );

//int       parse_line( measured_strings_ref configuration, char * line );

int     add_configuration( measured_strings_ref configuration, const char * name, const char * value );

int     read_configuration( void );

int     startup( void );

netif_device_id_t   generate_new_device_id( void );

static networking_globals_t networking_globals;

int networking_call( ipc_callid_t callid ){

    return EOK;

}

int networking_initialize( void ){

    ERROR_DECLARE;

    task_id_t   task_id;

    netifs_initialize( & networking_globals.netifs );

    char_map_initialize( & networking_globals.netif_names );

    modules_initialize( & networking_globals.modules );

    measured_strings_initialize( & networking_globals.configuration );

    // run self tests

//  ERROR_PROPAGATE( self_test());

    ERROR_PROPAGATE( add_module( NULL, & networking_globals.modules, LO_NAME, LO_FILENAME, SERVICE_LO, 0 ));

    ERROR_PROPAGATE( add_module( NULL, & networking_globals.modules, DP8390_ISA_NAME, DP8390_ISA_FILENAME, SERVICE_DP8390_ISA, 0 ));

    ERROR_PROPAGATE( add_module( NULL, & networking_globals.modules, ETHERNET_NAME, ETHERNET_FILENAME, SERVICE_ETHERNET, 0 ));

#ifdef NETWORKING_modular

    task_id = spawn( "/sbin/ip" );

    if( ! task_id ) return EINVAL;

    ERROR_PROPAGATE( add_module( NULL, & networking_globals.modules, IP_NAME, IP_FILENAME, SERVICE_IP, task_id ));

//  if( ! spawn( "/sbin/udp" )) return EINVAL;

    if( ! spawn( "/sbin/tcp" )) return EINVAL;

//  if( ! spawn( "/sbin/socket" )) return EINVAL;

//  not always necesssary

//  if( ! spawn( "/sbin/arp" )) return EINVAL;

//  if( ! spawn( "/sbin/rarp" )) return EINVAL;

//  if( ! spawn( "/sbin/icmp" )) return EINVAL;

#else

#ifdef NETWORKING_module

    ipcarg_t    phonehash;

    ERROR_PROPAGATE( REGISTER_ME( SERVICE_IP, & phonehash ));

    ERROR_PROPAGATE( add_module( NULL, & networking_globals.modules, IP_NAME, IP_FILENAME, SERVICE_IP, task_get_id()));

    ERROR_PROPAGATE( ip_initialize());

//  ERROR_PROPAGATE( REGISTER_ME( SERVICE_ARP, & phonehash ));

//  ERROR_PROPAGATE( arp_initialize());

//  ERROR_PROPAGATE( REGISTER_ME( SERVICE_RARP, & phonehash ));

//  ERROR_PROPAGATE( rarp_initialize());

//  ERROR_PROPAGATE( REGISTER_ME( SERVICE_ICMP, & phonehash ));

//  ERROR_PROPAGATE( icmp_initialize());

//  ERROR_PROPAGATE( REGISTER_ME( SERVICE_UDP, & phonehash ));

//  ERROR_PROPAGATE( udp_initialize());

    ERROR_PROPAGATE( REGISTER_ME( SERVICE_TCP, & phonehash ));

    ERROR_PROPAGATE( tcp_initialize());

//  ERROR_PROPAGATE( REGISTER_ME( SERVICE_SOCKET, & phonehash ));

//  ERROR_PROPAGATE( socket_initialize());

//  ERROR_PROPAGATE( REGISTER_ME( SERVICE_ETHERNET, & phonehash ));

//  ERROR_PROPAGATE( ethernet_initialize());

#endif

#endif

    return EOK;

}

int networking_message( ipcarg_t method, ipcarg_t arg1, ipcarg_t arg2, ipcarg_t arg3, ipcarg_t * result1, ipcarg_t * result2, ipcarg_t * result3 ){

    ERROR_DECLARE;

    measured_string_ref strings;

    char *          data;

    int         index;

    measured_string_ref setting;

    measured_strings_ref    configuration;

    netif_ref       netif;

//  printf( "\nNetworking message: %d\n", method );

    switch( method ){

//      case IPC_M_CONNECT_ME_TO:

        case IPC_M_PHONE_HUNGUP:

            return EOK;

        case NET_NETWORKING_DEVICE:

            // TODO configure, register

            // arg1 = netif id

            printf( "\nNetworking: new netif %d", arg1 );

            return EOK;

        case NET_NETWORKING_GET_DEVICE_CONFIGURATION:

            // arg1 = netif id

            // arg2 = count

            ERROR_PROPAGATE( measured_strings_receive( & strings, & data, arg2 ));

            netif = netifs_find( & networking_globals.netifs, arg1 );

            if( netif ){

                configuration = & netif->configuration;

            }else{

                configuration = NULL;

            }

            for( index = 0; index < arg2; ++ index ){

                setting = measured_strings_find( configuration, strings[ index ].value );

                if( ! setting ){

                    setting = measured_strings_find( & networking_globals.configuration, strings[ index ].value );

                }

                if( setting ){

                    strings[ index ].length = setting->length;

                    strings[ index ].value = setting->value;

                }else{

                    strings[ index ].length = 0;

                    strings[ index ].value = NULL;

                }

            }

            // strings should not contain received data anymore

            free( data );

            ERROR_CODE = measured_strings_reply( strings, arg2 );

            free( strings );

            return ERROR_CODE;

        case NET_NETWORKING_GET_CONFIGURATION:

            // arg1 = count

            ERROR_PROPAGATE( measured_strings_receive( & strings, & data, arg1 ));

            for( index = 0; index < arg1; ++ index ){

                setting = measured_strings_find( & networking_globals.configuration, strings[ index ].value );

                if( setting ){

                    strings[ index ].length = setting->length;

                    strings[ index ].value = setting->value;

                }else{

                    strings[ index ].length = 0;

                    strings[ index ].value = NULL;

                }

            }

            // strings should not contain received data anymore

            free( data );

            ERROR_CODE = measured_strings_reply( strings, arg1 );

            free( strings );

            return ERROR_CODE;

        case NET_NETWORKING_STARTUP:

            return startup();

    }

    return ENOTSUP;

}

/*

int parse_line( measured_strings_ref configuration, char * line ){

    ERROR_DECLARE;

    measured_string_ref setting;

    char *          name;

    char *          value;

    // from the beginning

    name = line;

    // skip spaces

    while( isspace( * name )) ++ name;

    // remember the name start

    value = name;

    // skip the name

    while( isalnum( * value ) || ( * value == '_' )){

        // make uppercase

//      * value = toupper( * value );

        ++ value;

    }

    if( * value == '=' ){

        // terminate the name

        * value = '\0';

    }else{

        // terminate the name

        * value = '\0';

        // skip until '='

        ++ value;

        while(( * value ) && ( * value != '=' )) ++ value;

        // not found?

        if( * value != '=' ) return EINVAL;

    }

    ++ value;

    // skip spaces

    while( isspace( * value )) ++ value;

    // create a bulk measured string till the end

    setting = measured_string_create_bulk( value, -1 );

    if( ! setting ) return ENOMEM;

    // add the configuration setting

    if( ERROR_OCCURED( measured_strings_add( configuration, name, setting ))){

        free( setting );

        return ERROR_CODE;

    }

    return EOK;

}

*/

int add_configuration( measured_strings_ref configuration, const char * name, const char * value ){

    ERROR_DECLARE;

    measured_string_ref setting;

    setting = measured_string_create_bulk( value, 0 );

    if( ! setting ) return ENOMEM;

    // add the configuration setting

    if( ERROR_OCCURED( measured_strings_add( configuration, name, setting ))){

        free( setting );

        return ERROR_CODE;

    }

    return EOK;

}

netif_device_id_t generate_new_device_id( void ){

    return netifs_count( & networking_globals.netifs ) + 1;

}

int read_configuration( void ){

    ERROR_DECLARE;

    netif_ref       netif;

    measured_string_ref setting;

    services_t      internet_service;

    // read general configuration

    ERROR_PROPAGATE( add_configuration( & networking_globals.configuration, "IPV", "4" ));

    // read network interfaces configuration

    // static loopback initialization

    printf( "\nloopback initialization" );

    netif = ( netif_ref ) malloc( sizeof( netif_t ));

    if( ! netif ) return ENOMEM;

    netif->id = generate_new_device_id();

    ERROR_PROPAGATE( measured_strings_initialize( & netif->configuration ));

    if( ERROR_OCCURED( add_configuration( & netif->configuration, "NAME", LO_NAME ))

        || ERROR_OCCURED( add_configuration( & netif->configuration, "NETIF", LO_NAME ))

        || ERROR_OCCURED( add_configuration( & netif->configuration, "IL", IP_NAME ))

        || ERROR_OCCURED( add_configuration( & netif->configuration, "IP_CONFIG", "STATIC" ))

        || ERROR_OCCURED( add_configuration( & netif->configuration, "IP_ADDR", "127.0.0.1" ))

        || ERROR_OCCURED( add_configuration( & netif->configuration, "NETMASK", "255.255.255.255" ))

        ){

        measured_strings_destroy( & netif->configuration );

        free( netif );

        return ERROR_CODE;

    }

    // mandatory name

    printf( "\n\tname" );

    setting = measured_strings_find( & netif->configuration, "NAME" );

    if( ! setting ){

        measured_strings_destroy( & netif->configuration );

        free( netif );

        return EINVAL;

    }

    netif->name = setting->value;

    printf( " %s OK", netif->name );

    // mandatory netif

    printf( "\n\tnetif" );

    setting = measured_strings_find( & netif->configuration, "NETIF" );

    if( ! setting ){

        printf( " unknown" );

        measured_strings_destroy( & netif->configuration );

        free( netif );

        return EINVAL;

    }

//  printf( " find %s in %d?", setting->value, modules_count( & networking_globals.modules ));

    netif->driver_module = modules_find( & networking_globals.modules, setting->value );

    if( ! netif->driver_module ){

        printf( " not found" );

        // TODO register the unknown one

        measured_strings_destroy( & netif->configuration );

        free( netif );

        return EINVAL;

    }

    printf( " found" );

    if( ! netif->driver_module->task_id ){

        netif->driver_module->task_id = spawn( netif->driver_module->filename );

        if( ! netif->driver_module->task_id ){

            measured_strings_destroy( & netif->configuration );

            free( netif );

            return EINVAL;

        }

    }

    if( ! netif->driver_module->phone ){

        printf( " connect?" );

        netif->driver_module->phone = connect_to_service( netif->driver_module->service );

    }

    printf( " connected" );

    if( ERROR_OCCURED( ipc_call_sync_1_0( netif->driver_module->phone, NET_NETIF_PROBE, netif->id ))){

        measured_strings_destroy( & netif->configuration );

        free( netif );

        return ERROR_CODE;

    }

    ++ netif->driver_module->usage;

    printf( " OK" );

    // optional link layer

    printf( "\n\tlink layer" );

    setting = measured_strings_find( & netif->configuration, "LL" );

    if( setting ){

        netif->link_layer_module = modules_find( & networking_globals.modules, setting->value );

        if( ! netif->link_layer_module ){

            // TODO register the unknown one

            -- netif->driver_module->usage;

            measured_strings_destroy( & netif->configuration );

            free( netif );

            return EINVAL;

        }

        if( ! netif->link_layer_module->task_id ){

            netif->link_layer_module->task_id = spawn( netif->link_layer_module->filename );

            if( ! netif->link_layer_module->task_id ){

                -- netif->driver_module->usage;

                measured_strings_destroy( & netif->configuration );

                free( netif );

                return EINVAL;

            }

        }

        if( ! netif->link_layer_module->phone ){

            netif->link_layer_module->phone = connect_to_service( netif->link_layer_module->service );

        }

        if( ERROR_OCCURED( ipc_call_sync_2_0( netif->link_layer_module->phone, NET_LL_DEVICE, netif->id, netif->driver_module->service ))){

            -- netif->driver_module->usage;

            measured_strings_destroy( & netif->configuration );

            free( netif );

            return ERROR_CODE;

        }

        ++ netif->link_layer_module->usage;

        internet_service = netif->link_layer_module->service;

        printf( " OK" );

    }else{

        internet_service = netif->driver_module->service;

        printf( " none" );

    }

    // mandatory internet layer

    printf( "\n\tinternet layer" );

    setting = measured_strings_find( & netif->configuration, "IL" );

    if( ! setting ){

        -- netif->driver_module->usage;

        -- netif->link_layer_module->usage;

        measured_strings_destroy( & netif->configuration );

        free( netif );

        return EINVAL;

    }

    printf( " set %s", setting->value );

    netif->internet_layer_module = modules_find( & networking_globals.modules, setting->value );

    if( ! netif->internet_layer_module ){

        // TODO register the unknown one

        -- netif->driver_module->usage;

        -- netif->link_layer_module->usage;

        measured_strings_destroy( & netif->configuration );

        free( netif );

        return EINVAL;

    }

    printf( " found" );

    if( ! netif->internet_layer_module->task_id ){

        netif->internet_layer_module->task_id = spawn( netif->internet_layer_module->filename );

        if( ! netif->internet_layer_module->task_id ){

            -- netif->driver_module->usage;

            -- netif->link_layer_module->usage;

            measured_strings_destroy( & netif->configuration );

            free( netif );

            return EINVAL;

        }

    }

    if( ! netif->internet_layer_module->phone ){

        printf( " connect" );

        netif->internet_layer_module->phone = connect_to_service( netif->internet_layer_module->service );

    }

    if( ERROR_OCCURED( ipc_call_sync_2_0( netif->internet_layer_module->phone, NET_IL_DEVICE, netif->id, internet_service ))){

        measured_strings_destroy( & netif->configuration );

        free( netif );

        return ERROR_CODE;

    }

    ++ netif->internet_layer_module->usage;

    printf( " OK" );

    if( ERROR_OCCURED( netifs_add( & networking_globals.netifs, netif->id, netif ))){

        free( netif );

        return ERROR_CODE;

    }

    printf( "\nloopback OK" );

    // end of static loopback initialization

    return EOK;

}

task_id_t spawn( const char * fname ){

    const char  * argv[ 2 ];

    task_id_t   res;

//  printf( "Spawning %s\n", fname );

    argv[ 0 ] = fname;

    argv[ 1 ] = NULL;

    res = task_spawn( fname, argv );

    if( res != 0 ){

        /* Success */

        usleep( 50000 );

    }

    return res;

}

int startup( void ){

    ERROR_DECLARE;

    // read configuration files

    if( ERROR_OCCURED( read_configuration())) return ERROR_CODE;

    // start network interfaces and needed modules

//  start_device( "/sbin/lo", "/sbin/dummy_link_layer" );

    return EOK;

}