| 33,58 → 33,64 |
|---|
| /** @file |
| */ |
| |
| #include <as.h> |
| #include <async.h> |
| #include <errno.h> |
| #include <stdio.h> |
| |
| #include <ipc/ipc.h> |
| #include <ipc/services.h> |
| //#include <sys/mman.h> |
| |
| #include "../err.h" |
| #include "../measured_strings.h" |
| #include "../messages.h" |
| #include "../modules.h" |
| #include "../netif/netif_device_id_type.h" |
| #include "../packet.h" |
| |
| #include "../include/sockaddr.h" |
| #include "../include/socket.h" |
| #include "../netif/device.h" |
| |
| #include "ip.h" |
| #include "ip_messages.h" |
| #include "ip_module.h" |
| |
| #define DEFAULT_IPV 4 |
| #define DEFAULT_IPV 4 |
| |
| #define IPC_GET_DEVICE( call ) ( device_id_t ) IPC_GET_ARG1( * call ) |
| #define IPC_GET_PROTO( call ) ( int ) IPC_GET_ARG1( * call ) |
| #define IPC_GET_SERVICE( call ) ( services_t ) IPC_GET_ARG2( * 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 parse_address( char * value, address_ref address ); |
| 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 ){ |
| ip_netifs_initialize( & ip_globals.netifs ); |
| ip_protos_initialize( & ip_globals.protos ); |
| return EOK; |
| } |
| |
| int ip_call( ipc_callid_t callid ){ |
| 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 parse_address( char * value, address_ref address ){ |
| char * next; |
| int index; |
| |
| if( ! value ){ |
| ( * address )[ 0 ] = ( * address )[ 1 ] = ( * address )[ 2 ] = ( * address )[ 3 ] = 0; |
| return ENOENT; |
| } |
| next = value; |
| for( index = 0; index < 4; ++ index ){ |
| if(( ! next ) || ( ! * next )) return EINVAL; |
| if( index ) ++ next; |
| ( * address )[ index ] = strtoul( next, & next, 0 ); |
| } |
| return EOK; |
| } |
| |
| int ip_message( ipc_callid_t callid, ipcarg_t method, ipcarg_t arg1, ipcarg_t arg2, ipcarg_t arg3, ipcarg_t * result1, ipcarg_t * result2, ipcarg_t * result3 ){ |
| int ip_device_message( device_id_t device_id, services_t service ){ |
| ERROR_DECLARE; |
| |
| ip_netif_ref ip_netif; |
| 95,85 → 101,176 |
|---|
| measured_string_ref settings; |
| char * data; |
| |
| switch( method ){ |
| 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_OCCURED( measured_strings_send( ip_globals.networking_phone, configuration, count )) |
| || ERROR_OCCURED( measured_strings_return( ip_globals.networking_phone, & settings, & data, count ))){ |
| async_wait_for( message, NULL ); |
| 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 = ! strcmp( settings[ 1 ].value, "DHCP" ); |
| if( ip_netif->dhcp ){ |
| // TODO dhcp |
| free( ip_netif ); |
| return ENOTSUP; |
| }else if( ip_netif->ipv == 4 ){ |
| if( ERROR_OCCURED( inet_pton( AF_INET, settings[ 2 ].value, ( uint8_t * ) & ip_netif->address )) |
| || ERROR_OCCURED( 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( ip_netif ); |
| return EINVAL; |
| } |
| }else{ |
| // TODO ipv6 |
| free( ip_netif ); |
| return ENOTSUP; |
| } |
| // TODO ARP module |
| } |
| // TODO arp module |
| free( settings ); |
| free( data ); |
| // end request |
| // TODO mapping |
| async_wait_for( message, NULL ); |
| // print the settings |
| printf( "\n -IPV =\t%d", ip_netif->ipv ); |
| printf( "\n -configuration =\t%s", ip_netif->dhcp ? "dhcp" : "static" ); |
| // TODO ipv6 |
| data = malloc( INET_ADDRSTRLEN ); |
| if( data ){ |
| inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->address, data, INET_ADDRSTRLEN ); |
| printf( "\n -address =\t%s", data ); |
| inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->netmask, data, INET_ADDRSTRLEN ); |
| printf( "\n -netmask =\t%s", data ); |
| inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->gateway, data, INET_ADDRSTRLEN ); |
| printf( "\n -gateway =\t%s", data ); |
| inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->broadcast, data, INET_ADDRSTRLEN ); |
| printf( "\n -broadcast =\t%s", data ); |
| inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns1, data, INET_ADDRSTRLEN ); |
| printf( "\n -dns1 =\t%s", data ); |
| inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns2, data, INET_ADDRSTRLEN ); |
| printf( "\n -dns2 =\t%s", data ); |
| free( data ); |
| } |
| // TODO mapping |
| ip_netif->phone = bind_service( service, ip_netif->device_id, SERVICE_IP, 0, ip_driver_receiver ); |
| if( ERROR_OCCURED( ip_netifs_add( & ip_globals.netifs, ip_netif->device_id, ip_netif ))){ |
| free( ip_netif ); |
| return ERROR_CODE; |
| } |
| 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_OCCURED( result = packet_receive( & packet ))){ |
| ipc_answer_0( callid, ERROR_CODE ); |
| continue; |
| } |
| //result = ip_receive_message( IPC_GET_DEVICE( call ), packet ); |
| packet_destroy( packet ); |
| ipc_answer_0( callid, result ); |
| } |
| } |
| } |
| |
| int ip_state_message( device_id_t device_id, device_state_t state ){ |
| // TODO state |
| printf( "\nip - device %d changed state to %d\n", device_id, state ); |
| return EOK; |
| } |
| |
| int ip_register_message( int protocol, int phone ){ |
| ERROR_DECLARE; |
| |
| ip_proto_ref proto; |
| |
| proto = ( ip_proto_ref ) malloc( sizeof( ip_protos_t )); |
| if( ! proto ) return ENOMEM; |
| proto->protocol = protocol; |
| proto->phone = phone; |
| if( ERROR_OCCURED( ip_protos_add( & ip_globals.protos, proto->protocol, proto ))){ |
| free( proto ); |
| return ERROR_CODE; |
| } |
| 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 )); |
| 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: |
| if( result1 ) * result1 = arg1; |
| if( result2 ) * result2 = arg2; |
| if( result3 ) * result3 = arg3; |
| return EOK; |
| * 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: |
| ip_netif = ( ip_netif_ref ) malloc( sizeof( ip_netif_t )); |
| if( ! ip_netif ) return ENOMEM; |
| ip_netif->device_id = arg1; |
| // get configuration |
| message = async_send_2( ip_globals.networking_phone, NET_NETWORKING_GET_DEVICE_CONFIGURATION, ip_netif->device_id, count, & answer ); |
| // send names and get settings |
| if( ERROR_OCCURED( measured_strings_send( ip_globals.networking_phone, configuration, count )) |
| || ERROR_OCCURED( measured_strings_return( ip_globals.networking_phone, & settings, & data, count ))){ |
| async_wait_for( message, NULL ); |
| 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 = ! strcmp( settings[ 1 ].value, "DHCP" ); |
| if( ip_netif->dhcp ){ |
| // TODO dhcp |
| free( ip_netif ); |
| return ENOTSUP; |
| }else if( ip_netif->ipv == 4 ){ |
| if( ERROR_OCCURED( parse_address( settings[ 2 ].value, & ip_netif->address )) |
| || ERROR_OCCURED( parse_address( settings[ 3 ].value, & ip_netif->netmask )) |
| || ( parse_address( settings[ 4 ].value, & ip_netif->gateway ) == EINVAL ) |
| || ( parse_address( settings[ 5 ].value, & ip_netif->broadcast ) == EINVAL ) |
| || ( parse_address( settings[ 6 ].value, & ip_netif->dns1 ) == EINVAL ) |
| || ( parse_address( settings[ 7 ].value, & ip_netif->dns2 ) == EINVAL )){ |
| free( ip_netif ); |
| return EINVAL; |
| } |
| }else{ |
| // TODO ipv6 |
| free( ip_netif ); |
| return ENOTSUP; |
| } |
| // TODO ARP module |
| } |
| // print the settings |
| printf( "\n -IPV=%d", ip_netif->ipv ); |
| printf( "\n -configuration=%s", ip_netif->dhcp ? "dhcp" : "static" ); |
| // TODO ipv6 |
| printf( "\n -address=%d.%d.%d.%d", ip_netif->address[ 0 ], ip_netif->address[ 1 ], ip_netif->address[ 2 ], ip_netif->address[ 3 ] ); |
| printf( "\n -netmask=%d.%d.%d.%d", ip_netif->netmask[ 0 ], ip_netif->netmask[ 1 ], ip_netif->netmask[ 2 ], ip_netif->netmask[ 3 ] ); |
| printf( "\n -gateway=%d.%d.%d.%d", ip_netif->gateway[ 0 ], ip_netif->gateway[ 1 ], ip_netif->gateway[ 2 ], ip_netif->gateway[ 3 ] ); |
| printf( "\n -broadcast=%d.%d.%d.%d", ip_netif->broadcast[ 0 ], ip_netif->broadcast[ 1 ], ip_netif->broadcast[ 2 ], ip_netif->broadcast[ 3 ] ); |
| printf( "\n -dns1=%d.%d.%d.%d", ip_netif->dns1[ 0 ], ip_netif->dns1[ 1 ], ip_netif->dns1[ 2 ], ip_netif->dns1[ 3 ] ); |
| printf( "\n -dns2=%d.%d.%d.%d", ip_netif->dns2[ 0 ], ip_netif->dns2[ 1 ], ip_netif->dns2[ 2 ], ip_netif->dns2[ 3 ] ); |
| // TODO arp module |
| free( settings ); |
| free( data ); |
| // end request |
| async_wait_for( message, NULL ); |
| ip_netif->phone = connect_to_service( arg2 ); |
| if( ERROR_OCCURED( async_req_2_0( ip_netif->phone, NET_LL_REGISTER, arg1, SERVICE_IP )) |
| || ERROR_OCCURED( ip_netifs_add( & ip_globals.netifs, ip_netif->device_id, ip_netif ))){ |
| free( ip_netif ); |
| return ERROR_CODE; |
| } |
| return EOK; |
| case NET_IL_DEVICE_STATE_CHANGED: |
| case NET_LL_DEVICE_STATE_CHANGED: |
| // arg1 device id |
| // arg2 state |
| // TODO state |
| printf( "\nip - device %d changed state to %d\n", arg1, arg2 ); |
| case NET_IP_TCP_REGISTER: |
| ip_globals.tcp_phone = connect_to_service( arg1 ); |
| return EOK; |
| 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_receive( & packet )); |
| return ip_send_message( IPC_GET_DEVICE( call ), packet ); |
| } |
| return ENOTSUP; |
| } |