WebSVN – HelenOS – Diff – /branches/network/uspace/srv/net/il/ip/ip.c

 /*
  * 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 "../../netif/device.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_DEVICE( call )      ( device_id_t ) IPC_GET_ARG1( * call )
 #define IPC_GET_PACKET( call )      ( packet_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_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;
-    ip_netifs_initialize( & ip_globals.netifs );
+    ERROR_PROPAGATE( ip_netifs_initialize( & ip_globals.netifs ));
-    ip_protos_initialize( & ip_globals.protos );
+    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;
+    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 = ! strcmp( settings[ 1 ].value, "DHCP" );
+        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 );
-        // TODO ARP module
+                free( ip_netif );
+                return EINVAL;
+            }
+        }else{
+            ip_netif->arp = NULL;
+        }
+        free( settings );
+        free( data );
+    }
-    // TODO arp module
-    // TODO register
-    free( settings );
-    free( data );
-    // end request
     // TODO mapping
+    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 ){
+        message = async_send_3( ip_netif->arp->phone, NET_ARP_DEVICE, ip_netif->device_id, SERVICE_IP, service, & answer );
+        configuration[ 0 ].value = ( char * ) & ip_netif->address;
+        configuration[ 0 ].length = CONVERT_SIZE( in_addr_t, char, 1 );
+        if( ERROR_OCCURRED( measured_strings_send( ip_netif->arp->phone, & configuration[ 0 ], 1 ))){
+            free( ip_netif );
+            return ERROR_CODE;
+        }
-    async_wait_for( message, NULL );
+        async_wait_for( message, & result );
+        if( ERROR_OCCURRED( result )){
+            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
+    // 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 );
+    }
-    // TODO mapping
-    ip_netif->phone = bind_service( service, ip_netif->device_id, SERVICE_IP, 0, ip_driver_receiver );
-    if( ERROR_OCCURRED( 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_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 ){
     // 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;
+    int             index;
     proto = ( ip_proto_ref ) malloc( sizeof( ip_protos_t ));
     if( ! proto ) return ENOMEM;
     proto->protocol = protocol;
     proto->phone = phone;
-    if( ERROR_OCCURRED( ip_protos_add( & ip_globals.protos, proto->protocol, proto ))){
+    index = ip_protos_add( & ip_globals.protos, proto->protocol, proto );
+    if( index < 0 ){
         free( proto );
-        return ERROR_CODE;
+        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 ));
-    packet_release( ip_globals.networking_phone, packet_get_id( 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:
-            if( ERROR_OCCURRED( packet_translate( ip_globals.networking_phone, & packet, IPC_GET_PACKET( call )))){
+            ERROR_PROPAGATE( packet_translate( ip_globals.networking_phone, & packet, IPC_GET_PACKET( call )));
-                printf( "\nIP send E %d", ERROR_CODE );
-                return ERROR_CODE;
-            }
             return ip_send_message( IPC_GET_DEVICE( call ), packet );
+    }
     return ENOTSUP;
+}
 /** @}
  */

Subversion Repositories HelenOS

(root)/branches/network/uspace/srv/net/il/ip/ip.c @ 4728 – Rev 4163 → 4192